Subversion Repositories Kolibri OS

Rev

Rev 5271 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright 2012 Advanced Micro Devices, Inc.
  3.  *
  4.  * Permission is hereby granted, free of charge, to any person obtaining a
  5.  * copy of this software and associated documentation files (the "Software"),
  6.  * to deal in the Software without restriction, including without limitation
  7.  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  8.  * and/or sell copies of the Software, and to permit persons to whom the
  9.  * Software is furnished to do so, subject to the following conditions:
  10.  *
  11.  * The above copyright notice and this permission notice shall be included in
  12.  * all copies or substantial portions of the Software.
  13.  *
  14.  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15.  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16.  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  17.  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18.  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19.  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20.  * OTHER DEALINGS IN THE SOFTWARE.
  21.  *
  22.  */
  23.  
  24. #include "drmP.h"
  25. #include "radeon.h"
  26. #include "radeon_asic.h"
  27. #include "nid.h"
  28. #include "r600_dpm.h"
  29. #include "ni_dpm.h"
  30. #include "atom.h"
  31. #include <linux/math64.h>
  32. #include <linux/seq_file.h>
  33.  
  34. #define MC_CG_ARB_FREQ_F0           0x0a
  35. #define MC_CG_ARB_FREQ_F1           0x0b
  36. #define MC_CG_ARB_FREQ_F2           0x0c
  37. #define MC_CG_ARB_FREQ_F3           0x0d
  38.  
  39. #define SMC_RAM_END 0xC000
  40.  
  41. static const struct ni_cac_weights cac_weights_cayman_xt =
  42. {
  43.         0x15,
  44.         0x2,
  45.         0x19,
  46.         0x2,
  47.         0x8,
  48.         0x14,
  49.         0x2,
  50.         0x16,
  51.         0xE,
  52.         0x17,
  53.         0x13,
  54.         0x2B,
  55.         0x10,
  56.         0x7,
  57.         0x5,
  58.         0x5,
  59.         0x5,
  60.         0x2,
  61.         0x3,
  62.         0x9,
  63.         0x10,
  64.         0x10,
  65.         0x2B,
  66.         0xA,
  67.         0x9,
  68.         0x4,
  69.         0xD,
  70.         0xD,
  71.         0x3E,
  72.         0x18,
  73.         0x14,
  74.         0,
  75.         0x3,
  76.         0x3,
  77.         0x5,
  78.         0,
  79.         0x2,
  80.         0,
  81.         0,
  82.         0,
  83.         0,
  84.         0,
  85.         0,
  86.         0,
  87.         0,
  88.         0,
  89.         0x1CC,
  90.         0,
  91.         0x164,
  92.         1,
  93.         1,
  94.         1,
  95.         1,
  96.         12,
  97.         12,
  98.         12,
  99.         0x12,
  100.         0x1F,
  101.         132,
  102.         5,
  103.         7,
  104.         0,
  105.         { 0, 0, 0, 0, 0, 0, 0, 0 },
  106.         { 0, 0, 0, 0 },
  107.         true
  108. };
  109.  
  110. static const struct ni_cac_weights cac_weights_cayman_pro =
  111. {
  112.         0x16,
  113.         0x4,
  114.         0x10,
  115.         0x2,
  116.         0xA,
  117.         0x16,
  118.         0x2,
  119.         0x18,
  120.         0x10,
  121.         0x1A,
  122.         0x16,
  123.         0x2D,
  124.         0x12,
  125.         0xA,
  126.         0x6,
  127.         0x6,
  128.         0x6,
  129.         0x2,
  130.         0x4,
  131.         0xB,
  132.         0x11,
  133.         0x11,
  134.         0x2D,
  135.         0xC,
  136.         0xC,
  137.         0x7,
  138.         0x10,
  139.         0x10,
  140.         0x3F,
  141.         0x1A,
  142.         0x16,
  143.         0,
  144.         0x7,
  145.         0x4,
  146.         0x6,
  147.         1,
  148.         0x2,
  149.         0x1,
  150.         0,
  151.         0,
  152.         0,
  153.         0,
  154.         0,
  155.         0,
  156.         0x30,
  157.         0,
  158.         0x1CF,
  159.         0,
  160.         0x166,
  161.         1,
  162.         1,
  163.         1,
  164.         1,
  165.         12,
  166.         12,
  167.         12,
  168.         0x15,
  169.         0x1F,
  170.         132,
  171.         6,
  172.         6,
  173.         0,
  174.         { 0, 0, 0, 0, 0, 0, 0, 0 },
  175.         { 0, 0, 0, 0 },
  176.         true
  177. };
  178.  
  179. static const struct ni_cac_weights cac_weights_cayman_le =
  180. {
  181.         0x7,
  182.         0xE,
  183.         0x1,
  184.         0xA,
  185.         0x1,
  186.         0x3F,
  187.         0x2,
  188.         0x18,
  189.         0x10,
  190.         0x1A,
  191.         0x1,
  192.         0x3F,
  193.         0x1,
  194.         0xE,
  195.         0x6,
  196.         0x6,
  197.         0x6,
  198.         0x2,
  199.         0x4,
  200.         0x9,
  201.         0x1A,
  202.         0x1A,
  203.         0x2C,
  204.         0xA,
  205.         0x11,
  206.         0x8,
  207.         0x19,
  208.         0x19,
  209.         0x1,
  210.         0x1,
  211.         0x1A,
  212.         0,
  213.         0x8,
  214.         0x5,
  215.         0x8,
  216.         0x1,
  217.         0x3,
  218.         0x1,
  219.         0,
  220.         0,
  221.         0,
  222.         0,
  223.         0,
  224.         0,
  225.         0x38,
  226.         0x38,
  227.         0x239,
  228.         0x3,
  229.         0x18A,
  230.         1,
  231.         1,
  232.         1,
  233.         1,
  234.         12,
  235.         12,
  236.         12,
  237.         0x15,
  238.         0x22,
  239.         132,
  240.         6,
  241.         6,
  242.         0,
  243.         { 0, 0, 0, 0, 0, 0, 0, 0 },
  244.         { 0, 0, 0, 0 },
  245.         true
  246. };
  247.  
  248. #define NISLANDS_MGCG_SEQUENCE  300
  249.  
  250. static const u32 cayman_cgcg_cgls_default[] =
  251. {
  252.         0x000008f8, 0x00000010, 0xffffffff,
  253.         0x000008fc, 0x00000000, 0xffffffff,
  254.         0x000008f8, 0x00000011, 0xffffffff,
  255.         0x000008fc, 0x00000000, 0xffffffff,
  256.         0x000008f8, 0x00000012, 0xffffffff,
  257.         0x000008fc, 0x00000000, 0xffffffff,
  258.         0x000008f8, 0x00000013, 0xffffffff,
  259.         0x000008fc, 0x00000000, 0xffffffff,
  260.         0x000008f8, 0x00000014, 0xffffffff,
  261.         0x000008fc, 0x00000000, 0xffffffff,
  262.         0x000008f8, 0x00000015, 0xffffffff,
  263.         0x000008fc, 0x00000000, 0xffffffff,
  264.         0x000008f8, 0x00000016, 0xffffffff,
  265.         0x000008fc, 0x00000000, 0xffffffff,
  266.         0x000008f8, 0x00000017, 0xffffffff,
  267.         0x000008fc, 0x00000000, 0xffffffff,
  268.         0x000008f8, 0x00000018, 0xffffffff,
  269.         0x000008fc, 0x00000000, 0xffffffff,
  270.         0x000008f8, 0x00000019, 0xffffffff,
  271.         0x000008fc, 0x00000000, 0xffffffff,
  272.         0x000008f8, 0x0000001a, 0xffffffff,
  273.         0x000008fc, 0x00000000, 0xffffffff,
  274.         0x000008f8, 0x0000001b, 0xffffffff,
  275.         0x000008fc, 0x00000000, 0xffffffff,
  276.         0x000008f8, 0x00000020, 0xffffffff,
  277.         0x000008fc, 0x00000000, 0xffffffff,
  278.         0x000008f8, 0x00000021, 0xffffffff,
  279.         0x000008fc, 0x00000000, 0xffffffff,
  280.         0x000008f8, 0x00000022, 0xffffffff,
  281.         0x000008fc, 0x00000000, 0xffffffff,
  282.         0x000008f8, 0x00000023, 0xffffffff,
  283.         0x000008fc, 0x00000000, 0xffffffff,
  284.         0x000008f8, 0x00000024, 0xffffffff,
  285.         0x000008fc, 0x00000000, 0xffffffff,
  286.         0x000008f8, 0x00000025, 0xffffffff,
  287.         0x000008fc, 0x00000000, 0xffffffff,
  288.         0x000008f8, 0x00000026, 0xffffffff,
  289.         0x000008fc, 0x00000000, 0xffffffff,
  290.         0x000008f8, 0x00000027, 0xffffffff,
  291.         0x000008fc, 0x00000000, 0xffffffff,
  292.         0x000008f8, 0x00000028, 0xffffffff,
  293.         0x000008fc, 0x00000000, 0xffffffff,
  294.         0x000008f8, 0x00000029, 0xffffffff,
  295.         0x000008fc, 0x00000000, 0xffffffff,
  296.         0x000008f8, 0x0000002a, 0xffffffff,
  297.         0x000008fc, 0x00000000, 0xffffffff,
  298.         0x000008f8, 0x0000002b, 0xffffffff,
  299.         0x000008fc, 0x00000000, 0xffffffff
  300. };
  301. #define CAYMAN_CGCG_CGLS_DEFAULT_LENGTH sizeof(cayman_cgcg_cgls_default) / (3 * sizeof(u32))
  302.  
  303. static const u32 cayman_cgcg_cgls_disable[] =
  304. {
  305.         0x000008f8, 0x00000010, 0xffffffff,
  306.         0x000008fc, 0xffffffff, 0xffffffff,
  307.         0x000008f8, 0x00000011, 0xffffffff,
  308.         0x000008fc, 0xffffffff, 0xffffffff,
  309.         0x000008f8, 0x00000012, 0xffffffff,
  310.         0x000008fc, 0xffffffff, 0xffffffff,
  311.         0x000008f8, 0x00000013, 0xffffffff,
  312.         0x000008fc, 0xffffffff, 0xffffffff,
  313.         0x000008f8, 0x00000014, 0xffffffff,
  314.         0x000008fc, 0xffffffff, 0xffffffff,
  315.         0x000008f8, 0x00000015, 0xffffffff,
  316.         0x000008fc, 0xffffffff, 0xffffffff,
  317.         0x000008f8, 0x00000016, 0xffffffff,
  318.         0x000008fc, 0xffffffff, 0xffffffff,
  319.         0x000008f8, 0x00000017, 0xffffffff,
  320.         0x000008fc, 0xffffffff, 0xffffffff,
  321.         0x000008f8, 0x00000018, 0xffffffff,
  322.         0x000008fc, 0xffffffff, 0xffffffff,
  323.         0x000008f8, 0x00000019, 0xffffffff,
  324.         0x000008fc, 0xffffffff, 0xffffffff,
  325.         0x000008f8, 0x0000001a, 0xffffffff,
  326.         0x000008fc, 0xffffffff, 0xffffffff,
  327.         0x000008f8, 0x0000001b, 0xffffffff,
  328.         0x000008fc, 0xffffffff, 0xffffffff,
  329.         0x000008f8, 0x00000020, 0xffffffff,
  330.         0x000008fc, 0x00000000, 0xffffffff,
  331.         0x000008f8, 0x00000021, 0xffffffff,
  332.         0x000008fc, 0x00000000, 0xffffffff,
  333.         0x000008f8, 0x00000022, 0xffffffff,
  334.         0x000008fc, 0x00000000, 0xffffffff,
  335.         0x000008f8, 0x00000023, 0xffffffff,
  336.         0x000008fc, 0x00000000, 0xffffffff,
  337.         0x000008f8, 0x00000024, 0xffffffff,
  338.         0x000008fc, 0x00000000, 0xffffffff,
  339.         0x000008f8, 0x00000025, 0xffffffff,
  340.         0x000008fc, 0x00000000, 0xffffffff,
  341.         0x000008f8, 0x00000026, 0xffffffff,
  342.         0x000008fc, 0x00000000, 0xffffffff,
  343.         0x000008f8, 0x00000027, 0xffffffff,
  344.         0x000008fc, 0x00000000, 0xffffffff,
  345.         0x000008f8, 0x00000028, 0xffffffff,
  346.         0x000008fc, 0x00000000, 0xffffffff,
  347.         0x000008f8, 0x00000029, 0xffffffff,
  348.         0x000008fc, 0x00000000, 0xffffffff,
  349.         0x000008f8, 0x0000002a, 0xffffffff,
  350.         0x000008fc, 0x00000000, 0xffffffff,
  351.         0x000008f8, 0x0000002b, 0xffffffff,
  352.         0x000008fc, 0x00000000, 0xffffffff,
  353.         0x00000644, 0x000f7902, 0x001f4180,
  354.         0x00000644, 0x000f3802, 0x001f4180
  355. };
  356. #define CAYMAN_CGCG_CGLS_DISABLE_LENGTH sizeof(cayman_cgcg_cgls_disable) / (3 * sizeof(u32))
  357.  
  358. static const u32 cayman_cgcg_cgls_enable[] =
  359. {
  360.         0x00000644, 0x000f7882, 0x001f4080,
  361.         0x000008f8, 0x00000010, 0xffffffff,
  362.         0x000008fc, 0x00000000, 0xffffffff,
  363.         0x000008f8, 0x00000011, 0xffffffff,
  364.         0x000008fc, 0x00000000, 0xffffffff,
  365.         0x000008f8, 0x00000012, 0xffffffff,
  366.         0x000008fc, 0x00000000, 0xffffffff,
  367.         0x000008f8, 0x00000013, 0xffffffff,
  368.         0x000008fc, 0x00000000, 0xffffffff,
  369.         0x000008f8, 0x00000014, 0xffffffff,
  370.         0x000008fc, 0x00000000, 0xffffffff,
  371.         0x000008f8, 0x00000015, 0xffffffff,
  372.         0x000008fc, 0x00000000, 0xffffffff,
  373.         0x000008f8, 0x00000016, 0xffffffff,
  374.         0x000008fc, 0x00000000, 0xffffffff,
  375.         0x000008f8, 0x00000017, 0xffffffff,
  376.         0x000008fc, 0x00000000, 0xffffffff,
  377.         0x000008f8, 0x00000018, 0xffffffff,
  378.         0x000008fc, 0x00000000, 0xffffffff,
  379.         0x000008f8, 0x00000019, 0xffffffff,
  380.         0x000008fc, 0x00000000, 0xffffffff,
  381.         0x000008f8, 0x0000001a, 0xffffffff,
  382.         0x000008fc, 0x00000000, 0xffffffff,
  383.         0x000008f8, 0x0000001b, 0xffffffff,
  384.         0x000008fc, 0x00000000, 0xffffffff,
  385.         0x000008f8, 0x00000020, 0xffffffff,
  386.         0x000008fc, 0xffffffff, 0xffffffff,
  387.         0x000008f8, 0x00000021, 0xffffffff,
  388.         0x000008fc, 0xffffffff, 0xffffffff,
  389.         0x000008f8, 0x00000022, 0xffffffff,
  390.         0x000008fc, 0xffffffff, 0xffffffff,
  391.         0x000008f8, 0x00000023, 0xffffffff,
  392.         0x000008fc, 0xffffffff, 0xffffffff,
  393.         0x000008f8, 0x00000024, 0xffffffff,
  394.         0x000008fc, 0xffffffff, 0xffffffff,
  395.         0x000008f8, 0x00000025, 0xffffffff,
  396.         0x000008fc, 0xffffffff, 0xffffffff,
  397.         0x000008f8, 0x00000026, 0xffffffff,
  398.         0x000008fc, 0xffffffff, 0xffffffff,
  399.         0x000008f8, 0x00000027, 0xffffffff,
  400.         0x000008fc, 0xffffffff, 0xffffffff,
  401.         0x000008f8, 0x00000028, 0xffffffff,
  402.         0x000008fc, 0xffffffff, 0xffffffff,
  403.         0x000008f8, 0x00000029, 0xffffffff,
  404.         0x000008fc, 0xffffffff, 0xffffffff,
  405.         0x000008f8, 0x0000002a, 0xffffffff,
  406.         0x000008fc, 0xffffffff, 0xffffffff,
  407.         0x000008f8, 0x0000002b, 0xffffffff,
  408.         0x000008fc, 0xffffffff, 0xffffffff
  409. };
  410. #define CAYMAN_CGCG_CGLS_ENABLE_LENGTH  sizeof(cayman_cgcg_cgls_enable) / (3 * sizeof(u32))
  411.  
  412. static const u32 cayman_mgcg_default[] =
  413. {
  414.         0x0000802c, 0xc0000000, 0xffffffff,
  415.         0x00003fc4, 0xc0000000, 0xffffffff,
  416.         0x00005448, 0x00000100, 0xffffffff,
  417.         0x000055e4, 0x00000100, 0xffffffff,
  418.         0x0000160c, 0x00000100, 0xffffffff,
  419.         0x00008984, 0x06000100, 0xffffffff,
  420.         0x0000c164, 0x00000100, 0xffffffff,
  421.         0x00008a18, 0x00000100, 0xffffffff,
  422.         0x0000897c, 0x06000100, 0xffffffff,
  423.         0x00008b28, 0x00000100, 0xffffffff,
  424.         0x00009144, 0x00800200, 0xffffffff,
  425.         0x00009a60, 0x00000100, 0xffffffff,
  426.         0x00009868, 0x00000100, 0xffffffff,
  427.         0x00008d58, 0x00000100, 0xffffffff,
  428.         0x00009510, 0x00000100, 0xffffffff,
  429.         0x0000949c, 0x00000100, 0xffffffff,
  430.         0x00009654, 0x00000100, 0xffffffff,
  431.         0x00009030, 0x00000100, 0xffffffff,
  432.         0x00009034, 0x00000100, 0xffffffff,
  433.         0x00009038, 0x00000100, 0xffffffff,
  434.         0x0000903c, 0x00000100, 0xffffffff,
  435.         0x00009040, 0x00000100, 0xffffffff,
  436.         0x0000a200, 0x00000100, 0xffffffff,
  437.         0x0000a204, 0x00000100, 0xffffffff,
  438.         0x0000a208, 0x00000100, 0xffffffff,
  439.         0x0000a20c, 0x00000100, 0xffffffff,
  440.         0x00009744, 0x00000100, 0xffffffff,
  441.         0x00003f80, 0x00000100, 0xffffffff,
  442.         0x0000a210, 0x00000100, 0xffffffff,
  443.         0x0000a214, 0x00000100, 0xffffffff,
  444.         0x000004d8, 0x00000100, 0xffffffff,
  445.         0x00009664, 0x00000100, 0xffffffff,
  446.         0x00009698, 0x00000100, 0xffffffff,
  447.         0x000004d4, 0x00000200, 0xffffffff,
  448.         0x000004d0, 0x00000000, 0xffffffff,
  449.         0x000030cc, 0x00000104, 0xffffffff,
  450.         0x0000d0c0, 0x00000100, 0xffffffff,
  451.         0x0000d8c0, 0x00000100, 0xffffffff,
  452.         0x0000802c, 0x40000000, 0xffffffff,
  453.         0x00003fc4, 0x40000000, 0xffffffff,
  454.         0x0000915c, 0x00010000, 0xffffffff,
  455.         0x00009160, 0x00030002, 0xffffffff,
  456.         0x00009164, 0x00050004, 0xffffffff,
  457.         0x00009168, 0x00070006, 0xffffffff,
  458.         0x00009178, 0x00070000, 0xffffffff,
  459.         0x0000917c, 0x00030002, 0xffffffff,
  460.         0x00009180, 0x00050004, 0xffffffff,
  461.         0x0000918c, 0x00010006, 0xffffffff,
  462.         0x00009190, 0x00090008, 0xffffffff,
  463.         0x00009194, 0x00070000, 0xffffffff,
  464.         0x00009198, 0x00030002, 0xffffffff,
  465.         0x0000919c, 0x00050004, 0xffffffff,
  466.         0x000091a8, 0x00010006, 0xffffffff,
  467.         0x000091ac, 0x00090008, 0xffffffff,
  468.         0x000091b0, 0x00070000, 0xffffffff,
  469.         0x000091b4, 0x00030002, 0xffffffff,
  470.         0x000091b8, 0x00050004, 0xffffffff,
  471.         0x000091c4, 0x00010006, 0xffffffff,
  472.         0x000091c8, 0x00090008, 0xffffffff,
  473.         0x000091cc, 0x00070000, 0xffffffff,
  474.         0x000091d0, 0x00030002, 0xffffffff,
  475.         0x000091d4, 0x00050004, 0xffffffff,
  476.         0x000091e0, 0x00010006, 0xffffffff,
  477.         0x000091e4, 0x00090008, 0xffffffff,
  478.         0x000091e8, 0x00000000, 0xffffffff,
  479.         0x000091ec, 0x00070000, 0xffffffff,
  480.         0x000091f0, 0x00030002, 0xffffffff,
  481.         0x000091f4, 0x00050004, 0xffffffff,
  482.         0x00009200, 0x00010006, 0xffffffff,
  483.         0x00009204, 0x00090008, 0xffffffff,
  484.         0x00009208, 0x00070000, 0xffffffff,
  485.         0x0000920c, 0x00030002, 0xffffffff,
  486.         0x00009210, 0x00050004, 0xffffffff,
  487.         0x0000921c, 0x00010006, 0xffffffff,
  488.         0x00009220, 0x00090008, 0xffffffff,
  489.         0x00009224, 0x00070000, 0xffffffff,
  490.         0x00009228, 0x00030002, 0xffffffff,
  491.         0x0000922c, 0x00050004, 0xffffffff,
  492.         0x00009238, 0x00010006, 0xffffffff,
  493.         0x0000923c, 0x00090008, 0xffffffff,
  494.         0x00009240, 0x00070000, 0xffffffff,
  495.         0x00009244, 0x00030002, 0xffffffff,
  496.         0x00009248, 0x00050004, 0xffffffff,
  497.         0x00009254, 0x00010006, 0xffffffff,
  498.         0x00009258, 0x00090008, 0xffffffff,
  499.         0x0000925c, 0x00070000, 0xffffffff,
  500.         0x00009260, 0x00030002, 0xffffffff,
  501.         0x00009264, 0x00050004, 0xffffffff,
  502.         0x00009270, 0x00010006, 0xffffffff,
  503.         0x00009274, 0x00090008, 0xffffffff,
  504.         0x00009278, 0x00070000, 0xffffffff,
  505.         0x0000927c, 0x00030002, 0xffffffff,
  506.         0x00009280, 0x00050004, 0xffffffff,
  507.         0x0000928c, 0x00010006, 0xffffffff,
  508.         0x00009290, 0x00090008, 0xffffffff,
  509.         0x000092a8, 0x00070000, 0xffffffff,
  510.         0x000092ac, 0x00030002, 0xffffffff,
  511.         0x000092b0, 0x00050004, 0xffffffff,
  512.         0x000092bc, 0x00010006, 0xffffffff,
  513.         0x000092c0, 0x00090008, 0xffffffff,
  514.         0x000092c4, 0x00070000, 0xffffffff,
  515.         0x000092c8, 0x00030002, 0xffffffff,
  516.         0x000092cc, 0x00050004, 0xffffffff,
  517.         0x000092d8, 0x00010006, 0xffffffff,
  518.         0x000092dc, 0x00090008, 0xffffffff,
  519.         0x00009294, 0x00000000, 0xffffffff,
  520.         0x0000802c, 0x40010000, 0xffffffff,
  521.         0x00003fc4, 0x40010000, 0xffffffff,
  522.         0x0000915c, 0x00010000, 0xffffffff,
  523.         0x00009160, 0x00030002, 0xffffffff,
  524.         0x00009164, 0x00050004, 0xffffffff,
  525.         0x00009168, 0x00070006, 0xffffffff,
  526.         0x00009178, 0x00070000, 0xffffffff,
  527.         0x0000917c, 0x00030002, 0xffffffff,
  528.         0x00009180, 0x00050004, 0xffffffff,
  529.         0x0000918c, 0x00010006, 0xffffffff,
  530.         0x00009190, 0x00090008, 0xffffffff,
  531.         0x00009194, 0x00070000, 0xffffffff,
  532.         0x00009198, 0x00030002, 0xffffffff,
  533.         0x0000919c, 0x00050004, 0xffffffff,
  534.         0x000091a8, 0x00010006, 0xffffffff,
  535.         0x000091ac, 0x00090008, 0xffffffff,
  536.         0x000091b0, 0x00070000, 0xffffffff,
  537.         0x000091b4, 0x00030002, 0xffffffff,
  538.         0x000091b8, 0x00050004, 0xffffffff,
  539.         0x000091c4, 0x00010006, 0xffffffff,
  540.         0x000091c8, 0x00090008, 0xffffffff,
  541.         0x000091cc, 0x00070000, 0xffffffff,
  542.         0x000091d0, 0x00030002, 0xffffffff,
  543.         0x000091d4, 0x00050004, 0xffffffff,
  544.         0x000091e0, 0x00010006, 0xffffffff,
  545.         0x000091e4, 0x00090008, 0xffffffff,
  546.         0x000091e8, 0x00000000, 0xffffffff,
  547.         0x000091ec, 0x00070000, 0xffffffff,
  548.         0x000091f0, 0x00030002, 0xffffffff,
  549.         0x000091f4, 0x00050004, 0xffffffff,
  550.         0x00009200, 0x00010006, 0xffffffff,
  551.         0x00009204, 0x00090008, 0xffffffff,
  552.         0x00009208, 0x00070000, 0xffffffff,
  553.         0x0000920c, 0x00030002, 0xffffffff,
  554.         0x00009210, 0x00050004, 0xffffffff,
  555.         0x0000921c, 0x00010006, 0xffffffff,
  556.         0x00009220, 0x00090008, 0xffffffff,
  557.         0x00009224, 0x00070000, 0xffffffff,
  558.         0x00009228, 0x00030002, 0xffffffff,
  559.         0x0000922c, 0x00050004, 0xffffffff,
  560.         0x00009238, 0x00010006, 0xffffffff,
  561.         0x0000923c, 0x00090008, 0xffffffff,
  562.         0x00009240, 0x00070000, 0xffffffff,
  563.         0x00009244, 0x00030002, 0xffffffff,
  564.         0x00009248, 0x00050004, 0xffffffff,
  565.         0x00009254, 0x00010006, 0xffffffff,
  566.         0x00009258, 0x00090008, 0xffffffff,
  567.         0x0000925c, 0x00070000, 0xffffffff,
  568.         0x00009260, 0x00030002, 0xffffffff,
  569.         0x00009264, 0x00050004, 0xffffffff,
  570.         0x00009270, 0x00010006, 0xffffffff,
  571.         0x00009274, 0x00090008, 0xffffffff,
  572.         0x00009278, 0x00070000, 0xffffffff,
  573.         0x0000927c, 0x00030002, 0xffffffff,
  574.         0x00009280, 0x00050004, 0xffffffff,
  575.         0x0000928c, 0x00010006, 0xffffffff,
  576.         0x00009290, 0x00090008, 0xffffffff,
  577.         0x000092a8, 0x00070000, 0xffffffff,
  578.         0x000092ac, 0x00030002, 0xffffffff,
  579.         0x000092b0, 0x00050004, 0xffffffff,
  580.         0x000092bc, 0x00010006, 0xffffffff,
  581.         0x000092c0, 0x00090008, 0xffffffff,
  582.         0x000092c4, 0x00070000, 0xffffffff,
  583.         0x000092c8, 0x00030002, 0xffffffff,
  584.         0x000092cc, 0x00050004, 0xffffffff,
  585.         0x000092d8, 0x00010006, 0xffffffff,
  586.         0x000092dc, 0x00090008, 0xffffffff,
  587.         0x00009294, 0x00000000, 0xffffffff,
  588.         0x0000802c, 0xc0000000, 0xffffffff,
  589.         0x00003fc4, 0xc0000000, 0xffffffff,
  590.         0x000008f8, 0x00000010, 0xffffffff,
  591.         0x000008fc, 0x00000000, 0xffffffff,
  592.         0x000008f8, 0x00000011, 0xffffffff,
  593.         0x000008fc, 0x00000000, 0xffffffff,
  594.         0x000008f8, 0x00000012, 0xffffffff,
  595.         0x000008fc, 0x00000000, 0xffffffff,
  596.         0x000008f8, 0x00000013, 0xffffffff,
  597.         0x000008fc, 0x00000000, 0xffffffff,
  598.         0x000008f8, 0x00000014, 0xffffffff,
  599.         0x000008fc, 0x00000000, 0xffffffff,
  600.         0x000008f8, 0x00000015, 0xffffffff,
  601.         0x000008fc, 0x00000000, 0xffffffff,
  602.         0x000008f8, 0x00000016, 0xffffffff,
  603.         0x000008fc, 0x00000000, 0xffffffff,
  604.         0x000008f8, 0x00000017, 0xffffffff,
  605.         0x000008fc, 0x00000000, 0xffffffff,
  606.         0x000008f8, 0x00000018, 0xffffffff,
  607.         0x000008fc, 0x00000000, 0xffffffff,
  608.         0x000008f8, 0x00000019, 0xffffffff,
  609.         0x000008fc, 0x00000000, 0xffffffff,
  610.         0x000008f8, 0x0000001a, 0xffffffff,
  611.         0x000008fc, 0x00000000, 0xffffffff,
  612.         0x000008f8, 0x0000001b, 0xffffffff,
  613.         0x000008fc, 0x00000000, 0xffffffff
  614. };
  615. #define CAYMAN_MGCG_DEFAULT_LENGTH sizeof(cayman_mgcg_default) / (3 * sizeof(u32))
  616.  
  617. static const u32 cayman_mgcg_disable[] =
  618. {
  619.         0x0000802c, 0xc0000000, 0xffffffff,
  620.         0x000008f8, 0x00000000, 0xffffffff,
  621.         0x000008fc, 0xffffffff, 0xffffffff,
  622.         0x000008f8, 0x00000001, 0xffffffff,
  623.         0x000008fc, 0xffffffff, 0xffffffff,
  624.         0x000008f8, 0x00000002, 0xffffffff,
  625.         0x000008fc, 0xffffffff, 0xffffffff,
  626.         0x000008f8, 0x00000003, 0xffffffff,
  627.         0x000008fc, 0xffffffff, 0xffffffff,
  628.         0x00009150, 0x00600000, 0xffffffff
  629. };
  630. #define CAYMAN_MGCG_DISABLE_LENGTH   sizeof(cayman_mgcg_disable) / (3 * sizeof(u32))
  631.  
  632. static const u32 cayman_mgcg_enable[] =
  633. {
  634.         0x0000802c, 0xc0000000, 0xffffffff,
  635.         0x000008f8, 0x00000000, 0xffffffff,
  636.         0x000008fc, 0x00000000, 0xffffffff,
  637.         0x000008f8, 0x00000001, 0xffffffff,
  638.         0x000008fc, 0x00000000, 0xffffffff,
  639.         0x000008f8, 0x00000002, 0xffffffff,
  640.         0x000008fc, 0x00600000, 0xffffffff,
  641.         0x000008f8, 0x00000003, 0xffffffff,
  642.         0x000008fc, 0x00000000, 0xffffffff,
  643.         0x00009150, 0x96944200, 0xffffffff
  644. };
  645.  
  646. #define CAYMAN_MGCG_ENABLE_LENGTH   sizeof(cayman_mgcg_enable) / (3 * sizeof(u32))
  647.  
  648. #define NISLANDS_SYSLS_SEQUENCE  100
  649.  
  650. static const u32 cayman_sysls_default[] =
  651. {
  652.         /* Register,   Value,     Mask bits */
  653.         0x000055e8, 0x00000000, 0xffffffff,
  654.         0x0000d0bc, 0x00000000, 0xffffffff,
  655.         0x0000d8bc, 0x00000000, 0xffffffff,
  656.         0x000015c0, 0x000c1401, 0xffffffff,
  657.         0x0000264c, 0x000c0400, 0xffffffff,
  658.         0x00002648, 0x000c0400, 0xffffffff,
  659.         0x00002650, 0x000c0400, 0xffffffff,
  660.         0x000020b8, 0x000c0400, 0xffffffff,
  661.         0x000020bc, 0x000c0400, 0xffffffff,
  662.         0x000020c0, 0x000c0c80, 0xffffffff,
  663.         0x0000f4a0, 0x000000c0, 0xffffffff,
  664.         0x0000f4a4, 0x00680fff, 0xffffffff,
  665.         0x00002f50, 0x00000404, 0xffffffff,
  666.         0x000004c8, 0x00000001, 0xffffffff,
  667.         0x000064ec, 0x00000000, 0xffffffff,
  668.         0x00000c7c, 0x00000000, 0xffffffff,
  669.         0x00008dfc, 0x00000000, 0xffffffff
  670. };
  671. #define CAYMAN_SYSLS_DEFAULT_LENGTH sizeof(cayman_sysls_default) / (3 * sizeof(u32))
  672.  
  673. static const u32 cayman_sysls_disable[] =
  674. {
  675.         /* Register,   Value,     Mask bits */
  676.         0x0000d0c0, 0x00000000, 0xffffffff,
  677.         0x0000d8c0, 0x00000000, 0xffffffff,
  678.         0x000055e8, 0x00000000, 0xffffffff,
  679.         0x0000d0bc, 0x00000000, 0xffffffff,
  680.         0x0000d8bc, 0x00000000, 0xffffffff,
  681.         0x000015c0, 0x00041401, 0xffffffff,
  682.         0x0000264c, 0x00040400, 0xffffffff,
  683.         0x00002648, 0x00040400, 0xffffffff,
  684.         0x00002650, 0x00040400, 0xffffffff,
  685.         0x000020b8, 0x00040400, 0xffffffff,
  686.         0x000020bc, 0x00040400, 0xffffffff,
  687.         0x000020c0, 0x00040c80, 0xffffffff,
  688.         0x0000f4a0, 0x000000c0, 0xffffffff,
  689.         0x0000f4a4, 0x00680000, 0xffffffff,
  690.         0x00002f50, 0x00000404, 0xffffffff,
  691.         0x000004c8, 0x00000001, 0xffffffff,
  692.         0x000064ec, 0x00007ffd, 0xffffffff,
  693.         0x00000c7c, 0x0000ff00, 0xffffffff,
  694.         0x00008dfc, 0x0000007f, 0xffffffff
  695. };
  696. #define CAYMAN_SYSLS_DISABLE_LENGTH sizeof(cayman_sysls_disable) / (3 * sizeof(u32))
  697.  
  698. static const u32 cayman_sysls_enable[] =
  699. {
  700.         /* Register,   Value,     Mask bits */
  701.         0x000055e8, 0x00000001, 0xffffffff,
  702.         0x0000d0bc, 0x00000100, 0xffffffff,
  703.         0x0000d8bc, 0x00000100, 0xffffffff,
  704.         0x000015c0, 0x000c1401, 0xffffffff,
  705.         0x0000264c, 0x000c0400, 0xffffffff,
  706.         0x00002648, 0x000c0400, 0xffffffff,
  707.         0x00002650, 0x000c0400, 0xffffffff,
  708.         0x000020b8, 0x000c0400, 0xffffffff,
  709.         0x000020bc, 0x000c0400, 0xffffffff,
  710.         0x000020c0, 0x000c0c80, 0xffffffff,
  711.         0x0000f4a0, 0x000000c0, 0xffffffff,
  712.         0x0000f4a4, 0x00680fff, 0xffffffff,
  713.         0x00002f50, 0x00000903, 0xffffffff,
  714.         0x000004c8, 0x00000000, 0xffffffff,
  715.         0x000064ec, 0x00000000, 0xffffffff,
  716.         0x00000c7c, 0x00000000, 0xffffffff,
  717.         0x00008dfc, 0x00000000, 0xffffffff
  718. };
  719. #define CAYMAN_SYSLS_ENABLE_LENGTH sizeof(cayman_sysls_enable) / (3 * sizeof(u32))
  720.  
  721. struct rv7xx_power_info *rv770_get_pi(struct radeon_device *rdev);
  722. struct evergreen_power_info *evergreen_get_pi(struct radeon_device *rdev);
  723.  
  724. extern int ni_mc_load_microcode(struct radeon_device *rdev);
  725.  
  726. struct ni_power_info *ni_get_pi(struct radeon_device *rdev)
  727. {
  728.         struct ni_power_info *pi = rdev->pm.dpm.priv;
  729.  
  730.         return pi;
  731. }
  732.  
  733. struct ni_ps *ni_get_ps(struct radeon_ps *rps)
  734. {
  735.         struct ni_ps *ps = rps->ps_priv;
  736.  
  737.         return ps;
  738. }
  739.  
  740. static void ni_calculate_leakage_for_v_and_t_formula(const struct ni_leakage_coeffients *coeff,
  741.                                                      u16 v, s32 t,
  742.                                                      u32 ileakage,
  743.                                                      u32 *leakage)
  744. {
  745.         s64 kt, kv, leakage_w, i_leakage, vddc, temperature;
  746.  
  747.         i_leakage = div64_s64(drm_int2fixp(ileakage), 1000);
  748.         vddc = div64_s64(drm_int2fixp(v), 1000);
  749.         temperature = div64_s64(drm_int2fixp(t), 1000);
  750.  
  751.         kt = drm_fixp_mul(div64_s64(drm_int2fixp(coeff->at), 1000),
  752.                           drm_fixp_exp(drm_fixp_mul(div64_s64(drm_int2fixp(coeff->bt), 1000), temperature)));
  753.         kv = drm_fixp_mul(div64_s64(drm_int2fixp(coeff->av), 1000),
  754.                           drm_fixp_exp(drm_fixp_mul(div64_s64(drm_int2fixp(coeff->bv), 1000), vddc)));
  755.  
  756.         leakage_w = drm_fixp_mul(drm_fixp_mul(drm_fixp_mul(i_leakage, kt), kv), vddc);
  757.  
  758.         *leakage = drm_fixp2int(leakage_w * 1000);
  759. }
  760.  
  761. static void ni_calculate_leakage_for_v_and_t(struct radeon_device *rdev,
  762.                                              const struct ni_leakage_coeffients *coeff,
  763.                                              u16 v,
  764.                                              s32 t,
  765.                                              u32 i_leakage,
  766.                                              u32 *leakage)
  767. {
  768.         ni_calculate_leakage_for_v_and_t_formula(coeff, v, t, i_leakage, leakage);
  769. }
  770.  
  771. bool ni_dpm_vblank_too_short(struct radeon_device *rdev)
  772. {
  773.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  774.         u32 vblank_time = r600_dpm_get_vblank_time(rdev);
  775.         /* we never hit the non-gddr5 limit so disable it */
  776.         u32 switch_limit = pi->mem_gddr5 ? 450 : 0;
  777.  
  778.         if (vblank_time < switch_limit)
  779.                 return true;
  780.         else
  781.                 return false;
  782.  
  783. }
  784.  
  785. static void ni_apply_state_adjust_rules(struct radeon_device *rdev,
  786.                                         struct radeon_ps *rps)
  787. {
  788.         struct ni_ps *ps = ni_get_ps(rps);
  789.         struct radeon_clock_and_voltage_limits *max_limits;
  790.         bool disable_mclk_switching;
  791.         u32 mclk;
  792.         u16 vddci;
  793.         int i;
  794.  
  795.         if ((rdev->pm.dpm.new_active_crtc_count > 1) ||
  796.             ni_dpm_vblank_too_short(rdev))
  797.                 disable_mclk_switching = true;
  798.         else
  799.                 disable_mclk_switching = false;
  800.  
  801.         if (rdev->pm.dpm.ac_power)
  802.                 max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
  803.         else
  804.                 max_limits = &rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc;
  805.  
  806.         if (rdev->pm.dpm.ac_power == false) {
  807.                 for (i = 0; i < ps->performance_level_count; i++) {
  808.                         if (ps->performance_levels[i].mclk > max_limits->mclk)
  809.                                 ps->performance_levels[i].mclk = max_limits->mclk;
  810.                         if (ps->performance_levels[i].sclk > max_limits->sclk)
  811.                                 ps->performance_levels[i].sclk = max_limits->sclk;
  812.                         if (ps->performance_levels[i].vddc > max_limits->vddc)
  813.                                 ps->performance_levels[i].vddc = max_limits->vddc;
  814.                         if (ps->performance_levels[i].vddci > max_limits->vddci)
  815.                                 ps->performance_levels[i].vddci = max_limits->vddci;
  816.                 }
  817.         }
  818.  
  819.         /* XXX validate the min clocks required for display */
  820.  
  821.         /* adjust low state */
  822.         if (disable_mclk_switching) {
  823.                 ps->performance_levels[0].mclk =
  824.                         ps->performance_levels[ps->performance_level_count - 1].mclk;
  825.                 ps->performance_levels[0].vddci =
  826.                         ps->performance_levels[ps->performance_level_count - 1].vddci;
  827.         }
  828.  
  829.         btc_skip_blacklist_clocks(rdev, max_limits->sclk, max_limits->mclk,
  830.                                   &ps->performance_levels[0].sclk,
  831.                                   &ps->performance_levels[0].mclk);
  832.  
  833.         for (i = 1; i < ps->performance_level_count; i++) {
  834.                 if (ps->performance_levels[i].sclk < ps->performance_levels[i - 1].sclk)
  835.                         ps->performance_levels[i].sclk = ps->performance_levels[i - 1].sclk;
  836.                 if (ps->performance_levels[i].vddc < ps->performance_levels[i - 1].vddc)
  837.                         ps->performance_levels[i].vddc = ps->performance_levels[i - 1].vddc;
  838.         }
  839.  
  840.         /* adjust remaining states */
  841.         if (disable_mclk_switching) {
  842.                 mclk = ps->performance_levels[0].mclk;
  843.                 vddci = ps->performance_levels[0].vddci;
  844.                 for (i = 1; i < ps->performance_level_count; i++) {
  845.                         if (mclk < ps->performance_levels[i].mclk)
  846.                                 mclk = ps->performance_levels[i].mclk;
  847.                         if (vddci < ps->performance_levels[i].vddci)
  848.                                 vddci = ps->performance_levels[i].vddci;
  849.                 }
  850.                 for (i = 0; i < ps->performance_level_count; i++) {
  851.                         ps->performance_levels[i].mclk = mclk;
  852.                         ps->performance_levels[i].vddci = vddci;
  853.                 }
  854.         } else {
  855.                 for (i = 1; i < ps->performance_level_count; i++) {
  856.                         if (ps->performance_levels[i].mclk < ps->performance_levels[i - 1].mclk)
  857.                                 ps->performance_levels[i].mclk = ps->performance_levels[i - 1].mclk;
  858.                         if (ps->performance_levels[i].vddci < ps->performance_levels[i - 1].vddci)
  859.                                 ps->performance_levels[i].vddci = ps->performance_levels[i - 1].vddci;
  860.                 }
  861.         }
  862.  
  863.         for (i = 1; i < ps->performance_level_count; i++)
  864.                 btc_skip_blacklist_clocks(rdev, max_limits->sclk, max_limits->mclk,
  865.                                           &ps->performance_levels[i].sclk,
  866.                                           &ps->performance_levels[i].mclk);
  867.  
  868.         for (i = 0; i < ps->performance_level_count; i++)
  869.                 btc_adjust_clock_combinations(rdev, max_limits,
  870.                                               &ps->performance_levels[i]);
  871.  
  872.         for (i = 0; i < ps->performance_level_count; i++) {
  873.                 btc_apply_voltage_dependency_rules(&rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk,
  874.                                                    ps->performance_levels[i].sclk,
  875.                                                    max_limits->vddc,  &ps->performance_levels[i].vddc);
  876.                 btc_apply_voltage_dependency_rules(&rdev->pm.dpm.dyn_state.vddci_dependency_on_mclk,
  877.                                                    ps->performance_levels[i].mclk,
  878.                                                    max_limits->vddci, &ps->performance_levels[i].vddci);
  879.                 btc_apply_voltage_dependency_rules(&rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk,
  880.                                                    ps->performance_levels[i].mclk,
  881.                                                    max_limits->vddc,  &ps->performance_levels[i].vddc);
  882.                 btc_apply_voltage_dependency_rules(&rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk,
  883.                                                    rdev->clock.current_dispclk,
  884.                                                    max_limits->vddc,  &ps->performance_levels[i].vddc);
  885.         }
  886.  
  887.         for (i = 0; i < ps->performance_level_count; i++) {
  888.                 btc_apply_voltage_delta_rules(rdev,
  889.                                               max_limits->vddc, max_limits->vddci,
  890.                                               &ps->performance_levels[i].vddc,
  891.                                               &ps->performance_levels[i].vddci);
  892.         }
  893.  
  894.         ps->dc_compatible = true;
  895.         for (i = 0; i < ps->performance_level_count; i++) {
  896.                 if (ps->performance_levels[i].vddc > rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.vddc)
  897.                         ps->dc_compatible = false;
  898.  
  899.                 if (ps->performance_levels[i].vddc < rdev->pm.dpm.dyn_state.min_vddc_for_pcie_gen2)
  900.                         ps->performance_levels[i].flags &= ~ATOM_PPLIB_R600_FLAGS_PCIEGEN2;
  901.         }
  902. }
  903.  
  904. static void ni_cg_clockgating_default(struct radeon_device *rdev)
  905. {
  906.         u32 count;
  907.         const u32 *ps = NULL;
  908.  
  909.         ps = (const u32 *)&cayman_cgcg_cgls_default;
  910.         count = CAYMAN_CGCG_CGLS_DEFAULT_LENGTH;
  911.  
  912.         btc_program_mgcg_hw_sequence(rdev, ps, count);
  913. }
  914.  
  915. static void ni_gfx_clockgating_enable(struct radeon_device *rdev,
  916.                                       bool enable)
  917. {
  918.         u32 count;
  919.         const u32 *ps = NULL;
  920.  
  921.         if (enable) {
  922.                 ps = (const u32 *)&cayman_cgcg_cgls_enable;
  923.                 count = CAYMAN_CGCG_CGLS_ENABLE_LENGTH;
  924.         } else {
  925.                 ps = (const u32 *)&cayman_cgcg_cgls_disable;
  926.                 count = CAYMAN_CGCG_CGLS_DISABLE_LENGTH;
  927.         }
  928.  
  929.         btc_program_mgcg_hw_sequence(rdev, ps, count);
  930. }
  931.  
  932. static void ni_mg_clockgating_default(struct radeon_device *rdev)
  933. {
  934.         u32 count;
  935.         const u32 *ps = NULL;
  936.  
  937.         ps = (const u32 *)&cayman_mgcg_default;
  938.         count = CAYMAN_MGCG_DEFAULT_LENGTH;
  939.  
  940.         btc_program_mgcg_hw_sequence(rdev, ps, count);
  941. }
  942.  
  943. static void ni_mg_clockgating_enable(struct radeon_device *rdev,
  944.                                      bool enable)
  945. {
  946.         u32 count;
  947.         const u32 *ps = NULL;
  948.  
  949.         if (enable) {
  950.                 ps = (const u32 *)&cayman_mgcg_enable;
  951.                 count = CAYMAN_MGCG_ENABLE_LENGTH;
  952.         } else {
  953.                 ps = (const u32 *)&cayman_mgcg_disable;
  954.                 count = CAYMAN_MGCG_DISABLE_LENGTH;
  955.         }
  956.  
  957.         btc_program_mgcg_hw_sequence(rdev, ps, count);
  958. }
  959.  
  960. static void ni_ls_clockgating_default(struct radeon_device *rdev)
  961. {
  962.         u32 count;
  963.         const u32 *ps = NULL;
  964.  
  965.         ps = (const u32 *)&cayman_sysls_default;
  966.         count = CAYMAN_SYSLS_DEFAULT_LENGTH;
  967.  
  968.         btc_program_mgcg_hw_sequence(rdev, ps, count);
  969. }
  970.  
  971. static void ni_ls_clockgating_enable(struct radeon_device *rdev,
  972.                                      bool enable)
  973. {
  974.         u32 count;
  975.         const u32 *ps = NULL;
  976.  
  977.         if (enable) {
  978.                 ps = (const u32 *)&cayman_sysls_enable;
  979.                 count = CAYMAN_SYSLS_ENABLE_LENGTH;
  980.         } else {
  981.                 ps = (const u32 *)&cayman_sysls_disable;
  982.                 count = CAYMAN_SYSLS_DISABLE_LENGTH;
  983.         }
  984.  
  985.         btc_program_mgcg_hw_sequence(rdev, ps, count);
  986.  
  987. }
  988.  
  989. static int ni_patch_single_dependency_table_based_on_leakage(struct radeon_device *rdev,
  990.                                                              struct radeon_clock_voltage_dependency_table *table)
  991. {
  992.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  993.         u32 i;
  994.  
  995.         if (table) {
  996.                 for (i = 0; i < table->count; i++) {
  997.                         if (0xff01 == table->entries[i].v) {
  998.                                 if (pi->max_vddc == 0)
  999.                                         return -EINVAL;
  1000.                                 table->entries[i].v = pi->max_vddc;
  1001.                         }
  1002.                 }
  1003.         }
  1004.         return 0;
  1005. }
  1006.  
  1007. static int ni_patch_dependency_tables_based_on_leakage(struct radeon_device *rdev)
  1008. {
  1009.         int ret = 0;
  1010.  
  1011.         ret = ni_patch_single_dependency_table_based_on_leakage(rdev,
  1012.                                                                 &rdev->pm.dpm.dyn_state.vddc_dependency_on_sclk);
  1013.  
  1014.         ret = ni_patch_single_dependency_table_based_on_leakage(rdev,
  1015.                                                                 &rdev->pm.dpm.dyn_state.vddc_dependency_on_mclk);
  1016.         return ret;
  1017. }
  1018.  
  1019. static void ni_stop_dpm(struct radeon_device *rdev)
  1020. {
  1021.         WREG32_P(GENERAL_PWRMGT, 0, ~GLOBAL_PWRMGT_EN);
  1022. }
  1023.  
  1024. #if 0
  1025. static int ni_notify_hw_of_power_source(struct radeon_device *rdev,
  1026.                                         bool ac_power)
  1027. {
  1028.         if (ac_power)
  1029.                 return (rv770_send_msg_to_smc(rdev, PPSMC_MSG_RunningOnAC) == PPSMC_Result_OK) ?
  1030.                         0 : -EINVAL;
  1031.  
  1032.         return 0;
  1033. }
  1034. #endif
  1035.  
  1036. static PPSMC_Result ni_send_msg_to_smc_with_parameter(struct radeon_device *rdev,
  1037.                                                       PPSMC_Msg msg, u32 parameter)
  1038. {
  1039.         WREG32(SMC_SCRATCH0, parameter);
  1040.         return rv770_send_msg_to_smc(rdev, msg);
  1041. }
  1042.  
  1043. static int ni_restrict_performance_levels_before_switch(struct radeon_device *rdev)
  1044. {
  1045.         if (rv770_send_msg_to_smc(rdev, PPSMC_MSG_NoForcedLevel) != PPSMC_Result_OK)
  1046.                 return -EINVAL;
  1047.  
  1048.         return (ni_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_SetEnabledLevels, 1) == PPSMC_Result_OK) ?
  1049.                 0 : -EINVAL;
  1050. }
  1051.  
  1052. int ni_dpm_force_performance_level(struct radeon_device *rdev,
  1053.                                    enum radeon_dpm_forced_level level)
  1054. {
  1055.         if (level == RADEON_DPM_FORCED_LEVEL_HIGH) {
  1056.                 if (ni_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_SetEnabledLevels, 0) != PPSMC_Result_OK)
  1057.                         return -EINVAL;
  1058.  
  1059.                 if (ni_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_SetForcedLevels, 1) != PPSMC_Result_OK)
  1060.                         return -EINVAL;
  1061.         } else if (level == RADEON_DPM_FORCED_LEVEL_LOW) {
  1062.                 if (ni_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_SetForcedLevels, 0) != PPSMC_Result_OK)
  1063.                         return -EINVAL;
  1064.  
  1065.                 if (ni_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_SetEnabledLevels, 1) != PPSMC_Result_OK)
  1066.                         return -EINVAL;
  1067.         } else if (level == RADEON_DPM_FORCED_LEVEL_AUTO) {
  1068.                 if (ni_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_SetForcedLevels, 0) != PPSMC_Result_OK)
  1069.                         return -EINVAL;
  1070.  
  1071.                 if (ni_send_msg_to_smc_with_parameter(rdev, PPSMC_MSG_SetEnabledLevels, 0) != PPSMC_Result_OK)
  1072.                         return -EINVAL;
  1073.         }
  1074.  
  1075.         rdev->pm.dpm.forced_level = level;
  1076.  
  1077.         return 0;
  1078. }
  1079.  
  1080. static void ni_stop_smc(struct radeon_device *rdev)
  1081. {
  1082.         u32 tmp;
  1083.         int i;
  1084.  
  1085.         for (i = 0; i < rdev->usec_timeout; i++) {
  1086.                 tmp = RREG32(LB_SYNC_RESET_SEL) & LB_SYNC_RESET_SEL_MASK;
  1087.                 if (tmp != 1)
  1088.                         break;
  1089.                 udelay(1);
  1090.         }
  1091.  
  1092.         udelay(100);
  1093.  
  1094.         r7xx_stop_smc(rdev);
  1095. }
  1096.  
  1097. static int ni_process_firmware_header(struct radeon_device *rdev)
  1098. {
  1099.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1100.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1101.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1102.         u32 tmp;
  1103.         int ret;
  1104.  
  1105.         ret = rv770_read_smc_sram_dword(rdev,
  1106.                                         NISLANDS_SMC_FIRMWARE_HEADER_LOCATION +
  1107.                                         NISLANDS_SMC_FIRMWARE_HEADER_stateTable,
  1108.                                         &tmp, pi->sram_end);
  1109.  
  1110.         if (ret)
  1111.                 return ret;
  1112.  
  1113.         pi->state_table_start = (u16)tmp;
  1114.  
  1115.         ret = rv770_read_smc_sram_dword(rdev,
  1116.                                         NISLANDS_SMC_FIRMWARE_HEADER_LOCATION +
  1117.                                         NISLANDS_SMC_FIRMWARE_HEADER_softRegisters,
  1118.                                         &tmp, pi->sram_end);
  1119.  
  1120.         if (ret)
  1121.                 return ret;
  1122.  
  1123.         pi->soft_regs_start = (u16)tmp;
  1124.  
  1125.         ret = rv770_read_smc_sram_dword(rdev,
  1126.                                         NISLANDS_SMC_FIRMWARE_HEADER_LOCATION +
  1127.                                         NISLANDS_SMC_FIRMWARE_HEADER_mcRegisterTable,
  1128.                                         &tmp, pi->sram_end);
  1129.  
  1130.         if (ret)
  1131.                 return ret;
  1132.  
  1133.         eg_pi->mc_reg_table_start = (u16)tmp;
  1134.  
  1135.         ret = rv770_read_smc_sram_dword(rdev,
  1136.                                         NISLANDS_SMC_FIRMWARE_HEADER_LOCATION +
  1137.                                         NISLANDS_SMC_FIRMWARE_HEADER_fanTable,
  1138.                                         &tmp, pi->sram_end);
  1139.  
  1140.         if (ret)
  1141.                 return ret;
  1142.  
  1143.         ni_pi->fan_table_start = (u16)tmp;
  1144.  
  1145.         ret = rv770_read_smc_sram_dword(rdev,
  1146.                                         NISLANDS_SMC_FIRMWARE_HEADER_LOCATION +
  1147.                                         NISLANDS_SMC_FIRMWARE_HEADER_mcArbDramAutoRefreshTable,
  1148.                                         &tmp, pi->sram_end);
  1149.  
  1150.         if (ret)
  1151.                 return ret;
  1152.  
  1153.         ni_pi->arb_table_start = (u16)tmp;
  1154.  
  1155.         ret = rv770_read_smc_sram_dword(rdev,
  1156.                                         NISLANDS_SMC_FIRMWARE_HEADER_LOCATION +
  1157.                                         NISLANDS_SMC_FIRMWARE_HEADER_cacTable,
  1158.                                         &tmp, pi->sram_end);
  1159.  
  1160.         if (ret)
  1161.                 return ret;
  1162.  
  1163.         ni_pi->cac_table_start = (u16)tmp;
  1164.  
  1165.         ret = rv770_read_smc_sram_dword(rdev,
  1166.                                         NISLANDS_SMC_FIRMWARE_HEADER_LOCATION +
  1167.                                         NISLANDS_SMC_FIRMWARE_HEADER_spllTable,
  1168.                                         &tmp, pi->sram_end);
  1169.  
  1170.         if (ret)
  1171.                 return ret;
  1172.  
  1173.         ni_pi->spll_table_start = (u16)tmp;
  1174.  
  1175.  
  1176.         return ret;
  1177. }
  1178.  
  1179. static void ni_read_clock_registers(struct radeon_device *rdev)
  1180. {
  1181.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1182.  
  1183.         ni_pi->clock_registers.cg_spll_func_cntl = RREG32(CG_SPLL_FUNC_CNTL);
  1184.         ni_pi->clock_registers.cg_spll_func_cntl_2 = RREG32(CG_SPLL_FUNC_CNTL_2);
  1185.         ni_pi->clock_registers.cg_spll_func_cntl_3 = RREG32(CG_SPLL_FUNC_CNTL_3);
  1186.         ni_pi->clock_registers.cg_spll_func_cntl_4 = RREG32(CG_SPLL_FUNC_CNTL_4);
  1187.         ni_pi->clock_registers.cg_spll_spread_spectrum = RREG32(CG_SPLL_SPREAD_SPECTRUM);
  1188.         ni_pi->clock_registers.cg_spll_spread_spectrum_2 = RREG32(CG_SPLL_SPREAD_SPECTRUM_2);
  1189.         ni_pi->clock_registers.mpll_ad_func_cntl = RREG32(MPLL_AD_FUNC_CNTL);
  1190.         ni_pi->clock_registers.mpll_ad_func_cntl_2 = RREG32(MPLL_AD_FUNC_CNTL_2);
  1191.         ni_pi->clock_registers.mpll_dq_func_cntl = RREG32(MPLL_DQ_FUNC_CNTL);
  1192.         ni_pi->clock_registers.mpll_dq_func_cntl_2 = RREG32(MPLL_DQ_FUNC_CNTL_2);
  1193.         ni_pi->clock_registers.mclk_pwrmgt_cntl = RREG32(MCLK_PWRMGT_CNTL);
  1194.         ni_pi->clock_registers.dll_cntl = RREG32(DLL_CNTL);
  1195.         ni_pi->clock_registers.mpll_ss1 = RREG32(MPLL_SS1);
  1196.         ni_pi->clock_registers.mpll_ss2 = RREG32(MPLL_SS2);
  1197. }
  1198.  
  1199. #if 0
  1200. static int ni_enter_ulp_state(struct radeon_device *rdev)
  1201. {
  1202.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1203.  
  1204.         if (pi->gfx_clock_gating) {
  1205.                 WREG32_P(SCLK_PWRMGT_CNTL, 0, ~DYN_GFX_CLK_OFF_EN);
  1206.                 WREG32_P(SCLK_PWRMGT_CNTL, GFX_CLK_FORCE_ON, ~GFX_CLK_FORCE_ON);
  1207.                 WREG32_P(SCLK_PWRMGT_CNTL, 0, ~GFX_CLK_FORCE_ON);
  1208.                 RREG32(GB_ADDR_CONFIG);
  1209.         }
  1210.  
  1211.         WREG32_P(SMC_MSG, HOST_SMC_MSG(PPSMC_MSG_SwitchToMinimumPower),
  1212.                  ~HOST_SMC_MSG_MASK);
  1213.  
  1214.         udelay(25000);
  1215.  
  1216.         return 0;
  1217. }
  1218. #endif
  1219.  
  1220. static void ni_program_response_times(struct radeon_device *rdev)
  1221. {
  1222.         u32 voltage_response_time, backbias_response_time, acpi_delay_time, vbi_time_out;
  1223.         u32 vddc_dly, bb_dly, acpi_dly, vbi_dly, mclk_switch_limit;
  1224.         u32 reference_clock;
  1225.  
  1226.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_mvdd_chg_time, 1);
  1227.  
  1228.         voltage_response_time = (u32)rdev->pm.dpm.voltage_response_time;
  1229.         backbias_response_time = (u32)rdev->pm.dpm.backbias_response_time;
  1230.  
  1231.         if (voltage_response_time == 0)
  1232.                 voltage_response_time = 1000;
  1233.  
  1234.         if (backbias_response_time == 0)
  1235.                 backbias_response_time = 1000;
  1236.  
  1237.         acpi_delay_time = 15000;
  1238.         vbi_time_out = 100000;
  1239.  
  1240.         reference_clock = radeon_get_xclk(rdev);
  1241.  
  1242.         vddc_dly = (voltage_response_time  * reference_clock) / 1600;
  1243.         bb_dly   = (backbias_response_time * reference_clock) / 1600;
  1244.         acpi_dly = (acpi_delay_time * reference_clock) / 1600;
  1245.         vbi_dly  = (vbi_time_out * reference_clock) / 1600;
  1246.  
  1247.         mclk_switch_limit = (460 * reference_clock) / 100;
  1248.  
  1249.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_delay_vreg,  vddc_dly);
  1250.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_delay_bbias, bb_dly);
  1251.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_delay_acpi,  acpi_dly);
  1252.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_mclk_chg_timeout, vbi_dly);
  1253.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_mc_block_delay, 0xAA);
  1254.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_mclk_switch_lim, mclk_switch_limit);
  1255. }
  1256.  
  1257. static void ni_populate_smc_voltage_table(struct radeon_device *rdev,
  1258.                                           struct atom_voltage_table *voltage_table,
  1259.                                           NISLANDS_SMC_STATETABLE *table)
  1260. {
  1261.         unsigned int i;
  1262.  
  1263.         for (i = 0; i < voltage_table->count; i++) {
  1264.                 table->highSMIO[i] = 0;
  1265.                 table->lowSMIO[i] |= cpu_to_be32(voltage_table->entries[i].smio_low);
  1266.         }
  1267. }
  1268.  
  1269. static void ni_populate_smc_voltage_tables(struct radeon_device *rdev,
  1270.                                            NISLANDS_SMC_STATETABLE *table)
  1271. {
  1272.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1273.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1274.         unsigned char i;
  1275.  
  1276.         if (eg_pi->vddc_voltage_table.count) {
  1277.                 ni_populate_smc_voltage_table(rdev, &eg_pi->vddc_voltage_table, table);
  1278.                 table->voltageMaskTable.highMask[NISLANDS_SMC_VOLTAGEMASK_VDDC] = 0;
  1279.                 table->voltageMaskTable.lowMask[NISLANDS_SMC_VOLTAGEMASK_VDDC] =
  1280.                         cpu_to_be32(eg_pi->vddc_voltage_table.mask_low);
  1281.  
  1282.                 for (i = 0; i < eg_pi->vddc_voltage_table.count; i++) {
  1283.                         if (pi->max_vddc_in_table <= eg_pi->vddc_voltage_table.entries[i].value) {
  1284.                                 table->maxVDDCIndexInPPTable = i;
  1285.                                 break;
  1286.                         }
  1287.                 }
  1288.         }
  1289.  
  1290.         if (eg_pi->vddci_voltage_table.count) {
  1291.                 ni_populate_smc_voltage_table(rdev, &eg_pi->vddci_voltage_table, table);
  1292.  
  1293.                 table->voltageMaskTable.highMask[NISLANDS_SMC_VOLTAGEMASK_VDDCI] = 0;
  1294.                 table->voltageMaskTable.lowMask[NISLANDS_SMC_VOLTAGEMASK_VDDCI] =
  1295.                         cpu_to_be32(eg_pi->vddci_voltage_table.mask_low);
  1296.         }
  1297. }
  1298.  
  1299. static int ni_populate_voltage_value(struct radeon_device *rdev,
  1300.                                      struct atom_voltage_table *table,
  1301.                                      u16 value,
  1302.                                      NISLANDS_SMC_VOLTAGE_VALUE *voltage)
  1303. {
  1304.         unsigned int i;
  1305.  
  1306.         for (i = 0; i < table->count; i++) {
  1307.                 if (value <= table->entries[i].value) {
  1308.                         voltage->index = (u8)i;
  1309.                         voltage->value = cpu_to_be16(table->entries[i].value);
  1310.                         break;
  1311.                 }
  1312.         }
  1313.  
  1314.         if (i >= table->count)
  1315.                 return -EINVAL;
  1316.  
  1317.         return 0;
  1318. }
  1319.  
  1320. static void ni_populate_mvdd_value(struct radeon_device *rdev,
  1321.                                    u32 mclk,
  1322.                                    NISLANDS_SMC_VOLTAGE_VALUE *voltage)
  1323. {
  1324.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1325.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1326.  
  1327.         if (!pi->mvdd_control) {
  1328.                 voltage->index = eg_pi->mvdd_high_index;
  1329.                 voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
  1330.                 return;
  1331.         }
  1332.  
  1333.         if (mclk <= pi->mvdd_split_frequency) {
  1334.                 voltage->index = eg_pi->mvdd_low_index;
  1335.                 voltage->value = cpu_to_be16(MVDD_LOW_VALUE);
  1336.         } else {
  1337.                 voltage->index = eg_pi->mvdd_high_index;
  1338.                 voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
  1339.         }
  1340. }
  1341.  
  1342. static int ni_get_std_voltage_value(struct radeon_device *rdev,
  1343.                                     NISLANDS_SMC_VOLTAGE_VALUE *voltage,
  1344.                                     u16 *std_voltage)
  1345. {
  1346.         if (rdev->pm.dpm.dyn_state.cac_leakage_table.entries &&
  1347.             ((u32)voltage->index < rdev->pm.dpm.dyn_state.cac_leakage_table.count))
  1348.                 *std_voltage = rdev->pm.dpm.dyn_state.cac_leakage_table.entries[voltage->index].vddc;
  1349.         else
  1350.                 *std_voltage = be16_to_cpu(voltage->value);
  1351.  
  1352.         return 0;
  1353. }
  1354.  
  1355. static void ni_populate_std_voltage_value(struct radeon_device *rdev,
  1356.                                           u16 value, u8 index,
  1357.                                           NISLANDS_SMC_VOLTAGE_VALUE *voltage)
  1358. {
  1359.         voltage->index = index;
  1360.         voltage->value = cpu_to_be16(value);
  1361. }
  1362.  
  1363. static u32 ni_get_smc_power_scaling_factor(struct radeon_device *rdev)
  1364. {
  1365.         u32 xclk_period;
  1366.         u32 xclk = radeon_get_xclk(rdev);
  1367.         u32 tmp = RREG32(CG_CAC_CTRL) & TID_CNT_MASK;
  1368.  
  1369.         xclk_period = (1000000000UL / xclk);
  1370.         xclk_period /= 10000UL;
  1371.  
  1372.         return tmp * xclk_period;
  1373. }
  1374.  
  1375. static u32 ni_scale_power_for_smc(u32 power_in_watts, u32 scaling_factor)
  1376. {
  1377.         return (power_in_watts * scaling_factor) << 2;
  1378. }
  1379.  
  1380. static u32 ni_calculate_power_boost_limit(struct radeon_device *rdev,
  1381.                                           struct radeon_ps *radeon_state,
  1382.                                           u32 near_tdp_limit)
  1383. {
  1384.         struct ni_ps *state = ni_get_ps(radeon_state);
  1385.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1386.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1387.         u32 power_boost_limit = 0;
  1388.         int ret;
  1389.  
  1390.         if (ni_pi->enable_power_containment &&
  1391.             ni_pi->use_power_boost_limit) {
  1392.                 NISLANDS_SMC_VOLTAGE_VALUE vddc;
  1393.                 u16 std_vddc_med;
  1394.                 u16 std_vddc_high;
  1395.                 u64 tmp, n, d;
  1396.  
  1397.                 if (state->performance_level_count < 3)
  1398.                         return 0;
  1399.  
  1400.                 ret = ni_populate_voltage_value(rdev, &eg_pi->vddc_voltage_table,
  1401.                                                 state->performance_levels[state->performance_level_count - 2].vddc,
  1402.                                                 &vddc);
  1403.                 if (ret)
  1404.                         return 0;
  1405.  
  1406.                 ret = ni_get_std_voltage_value(rdev, &vddc, &std_vddc_med);
  1407.                 if (ret)
  1408.                         return 0;
  1409.  
  1410.                 ret = ni_populate_voltage_value(rdev, &eg_pi->vddc_voltage_table,
  1411.                                                 state->performance_levels[state->performance_level_count - 1].vddc,
  1412.                                                 &vddc);
  1413.                 if (ret)
  1414.                         return 0;
  1415.  
  1416.                 ret = ni_get_std_voltage_value(rdev, &vddc, &std_vddc_high);
  1417.                 if (ret)
  1418.                         return 0;
  1419.  
  1420.                 n = ((u64)near_tdp_limit * ((u64)std_vddc_med * (u64)std_vddc_med) * 90);
  1421.                 d = ((u64)std_vddc_high * (u64)std_vddc_high * 100);
  1422.                 tmp = div64_u64(n, d);
  1423.  
  1424.                 if (tmp >> 32)
  1425.                         return 0;
  1426.                 power_boost_limit = (u32)tmp;
  1427.         }
  1428.  
  1429.         return power_boost_limit;
  1430. }
  1431.  
  1432. static int ni_calculate_adjusted_tdp_limits(struct radeon_device *rdev,
  1433.                                             bool adjust_polarity,
  1434.                                             u32 tdp_adjustment,
  1435.                                             u32 *tdp_limit,
  1436.                                             u32 *near_tdp_limit)
  1437. {
  1438.         if (tdp_adjustment > (u32)rdev->pm.dpm.tdp_od_limit)
  1439.                 return -EINVAL;
  1440.  
  1441.         if (adjust_polarity) {
  1442.                 *tdp_limit = ((100 + tdp_adjustment) * rdev->pm.dpm.tdp_limit) / 100;
  1443.                 *near_tdp_limit = rdev->pm.dpm.near_tdp_limit + (*tdp_limit - rdev->pm.dpm.tdp_limit);
  1444.         } else {
  1445.                 *tdp_limit = ((100 - tdp_adjustment) * rdev->pm.dpm.tdp_limit) / 100;
  1446.                 *near_tdp_limit = rdev->pm.dpm.near_tdp_limit - (rdev->pm.dpm.tdp_limit - *tdp_limit);
  1447.         }
  1448.  
  1449.         return 0;
  1450. }
  1451.  
  1452. static int ni_populate_smc_tdp_limits(struct radeon_device *rdev,
  1453.                                       struct radeon_ps *radeon_state)
  1454. {
  1455.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1456.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1457.  
  1458.         if (ni_pi->enable_power_containment) {
  1459.                 NISLANDS_SMC_STATETABLE *smc_table = &ni_pi->smc_statetable;
  1460.                 u32 scaling_factor = ni_get_smc_power_scaling_factor(rdev);
  1461.                 u32 tdp_limit;
  1462.                 u32 near_tdp_limit;
  1463.                 u32 power_boost_limit;
  1464.                 int ret;
  1465.  
  1466.                 if (scaling_factor == 0)
  1467.                         return -EINVAL;
  1468.  
  1469.                 memset(smc_table, 0, sizeof(NISLANDS_SMC_STATETABLE));
  1470.  
  1471.                 ret = ni_calculate_adjusted_tdp_limits(rdev,
  1472.                                                        false, /* ??? */
  1473.                                                        rdev->pm.dpm.tdp_adjustment,
  1474.                                                        &tdp_limit,
  1475.                                                        &near_tdp_limit);
  1476.                 if (ret)
  1477.                         return ret;
  1478.  
  1479.                 power_boost_limit = ni_calculate_power_boost_limit(rdev, radeon_state,
  1480.                                                                    near_tdp_limit);
  1481.  
  1482.                 smc_table->dpm2Params.TDPLimit =
  1483.                         cpu_to_be32(ni_scale_power_for_smc(tdp_limit, scaling_factor));
  1484.                 smc_table->dpm2Params.NearTDPLimit =
  1485.                         cpu_to_be32(ni_scale_power_for_smc(near_tdp_limit, scaling_factor));
  1486.                 smc_table->dpm2Params.SafePowerLimit =
  1487.                         cpu_to_be32(ni_scale_power_for_smc((near_tdp_limit * NISLANDS_DPM2_TDP_SAFE_LIMIT_PERCENT) / 100,
  1488.                                                            scaling_factor));
  1489.                 smc_table->dpm2Params.PowerBoostLimit =
  1490.                         cpu_to_be32(ni_scale_power_for_smc(power_boost_limit, scaling_factor));
  1491.  
  1492.                 ret = rv770_copy_bytes_to_smc(rdev,
  1493.                                               (u16)(pi->state_table_start + offsetof(NISLANDS_SMC_STATETABLE, dpm2Params) +
  1494.                                                     offsetof(PP_NIslands_DPM2Parameters, TDPLimit)),
  1495.                                               (u8 *)(&smc_table->dpm2Params.TDPLimit),
  1496.                                               sizeof(u32) * 4, pi->sram_end);
  1497.                 if (ret)
  1498.                         return ret;
  1499.         }
  1500.  
  1501.         return 0;
  1502. }
  1503.  
  1504. int ni_copy_and_switch_arb_sets(struct radeon_device *rdev,
  1505.                                 u32 arb_freq_src, u32 arb_freq_dest)
  1506. {
  1507.         u32 mc_arb_dram_timing;
  1508.         u32 mc_arb_dram_timing2;
  1509.         u32 burst_time;
  1510.         u32 mc_cg_config;
  1511.  
  1512.         switch (arb_freq_src) {
  1513.         case MC_CG_ARB_FREQ_F0:
  1514.                 mc_arb_dram_timing  = RREG32(MC_ARB_DRAM_TIMING);
  1515.                 mc_arb_dram_timing2 = RREG32(MC_ARB_DRAM_TIMING2);
  1516.                 burst_time = (RREG32(MC_ARB_BURST_TIME) & STATE0_MASK) >> STATE0_SHIFT;
  1517.                 break;
  1518.         case MC_CG_ARB_FREQ_F1:
  1519.                 mc_arb_dram_timing  = RREG32(MC_ARB_DRAM_TIMING_1);
  1520.                 mc_arb_dram_timing2 = RREG32(MC_ARB_DRAM_TIMING2_1);
  1521.                 burst_time = (RREG32(MC_ARB_BURST_TIME) & STATE1_MASK) >> STATE1_SHIFT;
  1522.                 break;
  1523.         case MC_CG_ARB_FREQ_F2:
  1524.                 mc_arb_dram_timing  = RREG32(MC_ARB_DRAM_TIMING_2);
  1525.                 mc_arb_dram_timing2 = RREG32(MC_ARB_DRAM_TIMING2_2);
  1526.                 burst_time = (RREG32(MC_ARB_BURST_TIME) & STATE2_MASK) >> STATE2_SHIFT;
  1527.                 break;
  1528.         case MC_CG_ARB_FREQ_F3:
  1529.                 mc_arb_dram_timing  = RREG32(MC_ARB_DRAM_TIMING_3);
  1530.                 mc_arb_dram_timing2 = RREG32(MC_ARB_DRAM_TIMING2_3);
  1531.                 burst_time = (RREG32(MC_ARB_BURST_TIME) & STATE3_MASK) >> STATE3_SHIFT;
  1532.                 break;
  1533.         default:
  1534.                 return -EINVAL;
  1535.         }
  1536.  
  1537.         switch (arb_freq_dest) {
  1538.         case MC_CG_ARB_FREQ_F0:
  1539.                 WREG32(MC_ARB_DRAM_TIMING, mc_arb_dram_timing);
  1540.                 WREG32(MC_ARB_DRAM_TIMING2, mc_arb_dram_timing2);
  1541.                 WREG32_P(MC_ARB_BURST_TIME, STATE0(burst_time), ~STATE0_MASK);
  1542.                 break;
  1543.         case MC_CG_ARB_FREQ_F1:
  1544.                 WREG32(MC_ARB_DRAM_TIMING_1, mc_arb_dram_timing);
  1545.                 WREG32(MC_ARB_DRAM_TIMING2_1, mc_arb_dram_timing2);
  1546.                 WREG32_P(MC_ARB_BURST_TIME, STATE1(burst_time), ~STATE1_MASK);
  1547.                 break;
  1548.         case MC_CG_ARB_FREQ_F2:
  1549.                 WREG32(MC_ARB_DRAM_TIMING_2, mc_arb_dram_timing);
  1550.                 WREG32(MC_ARB_DRAM_TIMING2_2, mc_arb_dram_timing2);
  1551.                 WREG32_P(MC_ARB_BURST_TIME, STATE2(burst_time), ~STATE2_MASK);
  1552.                 break;
  1553.         case MC_CG_ARB_FREQ_F3:
  1554.                 WREG32(MC_ARB_DRAM_TIMING_3, mc_arb_dram_timing);
  1555.                 WREG32(MC_ARB_DRAM_TIMING2_3, mc_arb_dram_timing2);
  1556.                 WREG32_P(MC_ARB_BURST_TIME, STATE3(burst_time), ~STATE3_MASK);
  1557.                 break;
  1558.         default:
  1559.                 return -EINVAL;
  1560.         }
  1561.  
  1562.         mc_cg_config = RREG32(MC_CG_CONFIG) | 0x0000000F;
  1563.         WREG32(MC_CG_CONFIG, mc_cg_config);
  1564.         WREG32_P(MC_ARB_CG, CG_ARB_REQ(arb_freq_dest), ~CG_ARB_REQ_MASK);
  1565.  
  1566.         return 0;
  1567. }
  1568.  
  1569. static int ni_init_arb_table_index(struct radeon_device *rdev)
  1570. {
  1571.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1572.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1573.         u32 tmp;
  1574.         int ret;
  1575.  
  1576.         ret = rv770_read_smc_sram_dword(rdev, ni_pi->arb_table_start,
  1577.                                         &tmp, pi->sram_end);
  1578.         if (ret)
  1579.                 return ret;
  1580.  
  1581.         tmp &= 0x00FFFFFF;
  1582.         tmp |= ((u32)MC_CG_ARB_FREQ_F1) << 24;
  1583.  
  1584.         return rv770_write_smc_sram_dword(rdev, ni_pi->arb_table_start,
  1585.                                           tmp, pi->sram_end);
  1586. }
  1587.  
  1588. static int ni_initial_switch_from_arb_f0_to_f1(struct radeon_device *rdev)
  1589. {
  1590.         return ni_copy_and_switch_arb_sets(rdev, MC_CG_ARB_FREQ_F0, MC_CG_ARB_FREQ_F1);
  1591. }
  1592.  
  1593. static int ni_force_switch_to_arb_f0(struct radeon_device *rdev)
  1594. {
  1595.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1596.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1597.         u32 tmp;
  1598.         int ret;
  1599.  
  1600.         ret = rv770_read_smc_sram_dword(rdev, ni_pi->arb_table_start,
  1601.                                         &tmp, pi->sram_end);
  1602.         if (ret)
  1603.                 return ret;
  1604.  
  1605.         tmp = (tmp >> 24) & 0xff;
  1606.  
  1607.         if (tmp == MC_CG_ARB_FREQ_F0)
  1608.                 return 0;
  1609.  
  1610.         return ni_copy_and_switch_arb_sets(rdev, tmp, MC_CG_ARB_FREQ_F0);
  1611. }
  1612.  
  1613. static int ni_populate_memory_timing_parameters(struct radeon_device *rdev,
  1614.                                                 struct rv7xx_pl *pl,
  1615.                                                 SMC_NIslands_MCArbDramTimingRegisterSet *arb_regs)
  1616. {
  1617.         u32 dram_timing;
  1618.         u32 dram_timing2;
  1619.  
  1620.         arb_regs->mc_arb_rfsh_rate =
  1621.                 (u8)rv770_calculate_memory_refresh_rate(rdev, pl->sclk);
  1622.  
  1623.  
  1624.         radeon_atom_set_engine_dram_timings(rdev,
  1625.                                             pl->sclk,
  1626.                                             pl->mclk);
  1627.  
  1628.         dram_timing = RREG32(MC_ARB_DRAM_TIMING);
  1629.         dram_timing2 = RREG32(MC_ARB_DRAM_TIMING2);
  1630.  
  1631.         arb_regs->mc_arb_dram_timing  = cpu_to_be32(dram_timing);
  1632.         arb_regs->mc_arb_dram_timing2 = cpu_to_be32(dram_timing2);
  1633.  
  1634.         return 0;
  1635. }
  1636.  
  1637. static int ni_do_program_memory_timing_parameters(struct radeon_device *rdev,
  1638.                                                   struct radeon_ps *radeon_state,
  1639.                                                   unsigned int first_arb_set)
  1640. {
  1641.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1642.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1643.         struct ni_ps *state = ni_get_ps(radeon_state);
  1644.         SMC_NIslands_MCArbDramTimingRegisterSet arb_regs = { 0 };
  1645.         int i, ret = 0;
  1646.  
  1647.         for (i = 0; i < state->performance_level_count; i++) {
  1648.                 ret = ni_populate_memory_timing_parameters(rdev, &state->performance_levels[i], &arb_regs);
  1649.                 if (ret)
  1650.                         break;
  1651.  
  1652.                 ret = rv770_copy_bytes_to_smc(rdev,
  1653.                                               (u16)(ni_pi->arb_table_start +
  1654.                                                     offsetof(SMC_NIslands_MCArbDramTimingRegisters, data) +
  1655.                                                     sizeof(SMC_NIslands_MCArbDramTimingRegisterSet) * (first_arb_set + i)),
  1656.                                               (u8 *)&arb_regs,
  1657.                                               (u16)sizeof(SMC_NIslands_MCArbDramTimingRegisterSet),
  1658.                                               pi->sram_end);
  1659.                 if (ret)
  1660.                         break;
  1661.         }
  1662.         return ret;
  1663. }
  1664.  
  1665. static int ni_program_memory_timing_parameters(struct radeon_device *rdev,
  1666.                                                struct radeon_ps *radeon_new_state)
  1667. {
  1668.         return ni_do_program_memory_timing_parameters(rdev, radeon_new_state,
  1669.                                                       NISLANDS_DRIVER_STATE_ARB_INDEX);
  1670. }
  1671.  
  1672. static void ni_populate_initial_mvdd_value(struct radeon_device *rdev,
  1673.                                            struct NISLANDS_SMC_VOLTAGE_VALUE *voltage)
  1674. {
  1675.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1676.  
  1677.         voltage->index = eg_pi->mvdd_high_index;
  1678.         voltage->value = cpu_to_be16(MVDD_HIGH_VALUE);
  1679. }
  1680.  
  1681. static int ni_populate_smc_initial_state(struct radeon_device *rdev,
  1682.                                          struct radeon_ps *radeon_initial_state,
  1683.                                          NISLANDS_SMC_STATETABLE *table)
  1684. {
  1685.         struct ni_ps *initial_state = ni_get_ps(radeon_initial_state);
  1686.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1687.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1688.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1689.         u32 reg;
  1690.         int ret;
  1691.  
  1692.         table->initialState.levels[0].mclk.vMPLL_AD_FUNC_CNTL =
  1693.                 cpu_to_be32(ni_pi->clock_registers.mpll_ad_func_cntl);
  1694.         table->initialState.levels[0].mclk.vMPLL_AD_FUNC_CNTL_2 =
  1695.                 cpu_to_be32(ni_pi->clock_registers.mpll_ad_func_cntl_2);
  1696.         table->initialState.levels[0].mclk.vMPLL_DQ_FUNC_CNTL =
  1697.                 cpu_to_be32(ni_pi->clock_registers.mpll_dq_func_cntl);
  1698.         table->initialState.levels[0].mclk.vMPLL_DQ_FUNC_CNTL_2 =
  1699.                 cpu_to_be32(ni_pi->clock_registers.mpll_dq_func_cntl_2);
  1700.         table->initialState.levels[0].mclk.vMCLK_PWRMGT_CNTL =
  1701.                 cpu_to_be32(ni_pi->clock_registers.mclk_pwrmgt_cntl);
  1702.         table->initialState.levels[0].mclk.vDLL_CNTL =
  1703.                 cpu_to_be32(ni_pi->clock_registers.dll_cntl);
  1704.         table->initialState.levels[0].mclk.vMPLL_SS =
  1705.                 cpu_to_be32(ni_pi->clock_registers.mpll_ss1);
  1706.         table->initialState.levels[0].mclk.vMPLL_SS2 =
  1707.                 cpu_to_be32(ni_pi->clock_registers.mpll_ss2);
  1708.         table->initialState.levels[0].mclk.mclk_value =
  1709.                 cpu_to_be32(initial_state->performance_levels[0].mclk);
  1710.  
  1711.         table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL =
  1712.                 cpu_to_be32(ni_pi->clock_registers.cg_spll_func_cntl);
  1713.         table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_2 =
  1714.                 cpu_to_be32(ni_pi->clock_registers.cg_spll_func_cntl_2);
  1715.         table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_3 =
  1716.                 cpu_to_be32(ni_pi->clock_registers.cg_spll_func_cntl_3);
  1717.         table->initialState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_4 =
  1718.                 cpu_to_be32(ni_pi->clock_registers.cg_spll_func_cntl_4);
  1719.         table->initialState.levels[0].sclk.vCG_SPLL_SPREAD_SPECTRUM =
  1720.                 cpu_to_be32(ni_pi->clock_registers.cg_spll_spread_spectrum);
  1721.         table->initialState.levels[0].sclk.vCG_SPLL_SPREAD_SPECTRUM_2 =
  1722.                 cpu_to_be32(ni_pi->clock_registers.cg_spll_spread_spectrum_2);
  1723.         table->initialState.levels[0].sclk.sclk_value =
  1724.                 cpu_to_be32(initial_state->performance_levels[0].sclk);
  1725.         table->initialState.levels[0].arbRefreshState =
  1726.                 NISLANDS_INITIAL_STATE_ARB_INDEX;
  1727.  
  1728.         table->initialState.levels[0].ACIndex = 0;
  1729.  
  1730.         ret = ni_populate_voltage_value(rdev, &eg_pi->vddc_voltage_table,
  1731.                                         initial_state->performance_levels[0].vddc,
  1732.                                         &table->initialState.levels[0].vddc);
  1733.         if (!ret) {
  1734.                 u16 std_vddc;
  1735.  
  1736.                 ret = ni_get_std_voltage_value(rdev,
  1737.                                                &table->initialState.levels[0].vddc,
  1738.                                                &std_vddc);
  1739.                 if (!ret)
  1740.                         ni_populate_std_voltage_value(rdev, std_vddc,
  1741.                                                       table->initialState.levels[0].vddc.index,
  1742.                                                       &table->initialState.levels[0].std_vddc);
  1743.         }
  1744.  
  1745.         if (eg_pi->vddci_control)
  1746.                 ni_populate_voltage_value(rdev,
  1747.                                           &eg_pi->vddci_voltage_table,
  1748.                                           initial_state->performance_levels[0].vddci,
  1749.                                           &table->initialState.levels[0].vddci);
  1750.  
  1751.         ni_populate_initial_mvdd_value(rdev, &table->initialState.levels[0].mvdd);
  1752.  
  1753.         reg = CG_R(0xffff) | CG_L(0);
  1754.         table->initialState.levels[0].aT = cpu_to_be32(reg);
  1755.  
  1756.         table->initialState.levels[0].bSP = cpu_to_be32(pi->dsp);
  1757.  
  1758.         if (pi->boot_in_gen2)
  1759.                 table->initialState.levels[0].gen2PCIE = 1;
  1760.         else
  1761.                 table->initialState.levels[0].gen2PCIE = 0;
  1762.  
  1763.         if (pi->mem_gddr5) {
  1764.                 table->initialState.levels[0].strobeMode =
  1765.                         cypress_get_strobe_mode_settings(rdev,
  1766.                                                          initial_state->performance_levels[0].mclk);
  1767.  
  1768.                 if (initial_state->performance_levels[0].mclk > pi->mclk_edc_enable_threshold)
  1769.                         table->initialState.levels[0].mcFlags = NISLANDS_SMC_MC_EDC_RD_FLAG | NISLANDS_SMC_MC_EDC_WR_FLAG;
  1770.                 else
  1771.                         table->initialState.levels[0].mcFlags =  0;
  1772.         }
  1773.  
  1774.         table->initialState.levelCount = 1;
  1775.  
  1776.         table->initialState.flags |= PPSMC_SWSTATE_FLAG_DC;
  1777.  
  1778.         table->initialState.levels[0].dpm2.MaxPS = 0;
  1779.         table->initialState.levels[0].dpm2.NearTDPDec = 0;
  1780.         table->initialState.levels[0].dpm2.AboveSafeInc = 0;
  1781.         table->initialState.levels[0].dpm2.BelowSafeInc = 0;
  1782.  
  1783.         reg = MIN_POWER_MASK | MAX_POWER_MASK;
  1784.         table->initialState.levels[0].SQPowerThrottle = cpu_to_be32(reg);
  1785.  
  1786.         reg = MAX_POWER_DELTA_MASK | STI_SIZE_MASK | LTI_RATIO_MASK;
  1787.         table->initialState.levels[0].SQPowerThrottle_2 = cpu_to_be32(reg);
  1788.  
  1789.         return 0;
  1790. }
  1791.  
  1792. static int ni_populate_smc_acpi_state(struct radeon_device *rdev,
  1793.                                       NISLANDS_SMC_STATETABLE *table)
  1794. {
  1795.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1796.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  1797.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1798.         u32 mpll_ad_func_cntl   = ni_pi->clock_registers.mpll_ad_func_cntl;
  1799.         u32 mpll_ad_func_cntl_2 = ni_pi->clock_registers.mpll_ad_func_cntl_2;
  1800.         u32 mpll_dq_func_cntl   = ni_pi->clock_registers.mpll_dq_func_cntl;
  1801.         u32 mpll_dq_func_cntl_2 = ni_pi->clock_registers.mpll_dq_func_cntl_2;
  1802.         u32 spll_func_cntl      = ni_pi->clock_registers.cg_spll_func_cntl;
  1803.         u32 spll_func_cntl_2    = ni_pi->clock_registers.cg_spll_func_cntl_2;
  1804.         u32 spll_func_cntl_3    = ni_pi->clock_registers.cg_spll_func_cntl_3;
  1805.         u32 spll_func_cntl_4    = ni_pi->clock_registers.cg_spll_func_cntl_4;
  1806.         u32 mclk_pwrmgt_cntl    = ni_pi->clock_registers.mclk_pwrmgt_cntl;
  1807.         u32 dll_cntl            = ni_pi->clock_registers.dll_cntl;
  1808.         u32 reg;
  1809.         int ret;
  1810.  
  1811.         table->ACPIState = table->initialState;
  1812.  
  1813.         table->ACPIState.flags &= ~PPSMC_SWSTATE_FLAG_DC;
  1814.  
  1815.         if (pi->acpi_vddc) {
  1816.                 ret = ni_populate_voltage_value(rdev,
  1817.                                                 &eg_pi->vddc_voltage_table,
  1818.                                                 pi->acpi_vddc, &table->ACPIState.levels[0].vddc);
  1819.                 if (!ret) {
  1820.                         u16 std_vddc;
  1821.  
  1822.                         ret = ni_get_std_voltage_value(rdev,
  1823.                                                        &table->ACPIState.levels[0].vddc, &std_vddc);
  1824.                         if (!ret)
  1825.                                 ni_populate_std_voltage_value(rdev, std_vddc,
  1826.                                                               table->ACPIState.levels[0].vddc.index,
  1827.                                                               &table->ACPIState.levels[0].std_vddc);
  1828.                 }
  1829.  
  1830.                 if (pi->pcie_gen2) {
  1831.                         if (pi->acpi_pcie_gen2)
  1832.                                 table->ACPIState.levels[0].gen2PCIE = 1;
  1833.                         else
  1834.                                 table->ACPIState.levels[0].gen2PCIE = 0;
  1835.                 } else {
  1836.                         table->ACPIState.levels[0].gen2PCIE = 0;
  1837.                 }
  1838.         } else {
  1839.                 ret = ni_populate_voltage_value(rdev,
  1840.                                                 &eg_pi->vddc_voltage_table,
  1841.                                                 pi->min_vddc_in_table,
  1842.                                                 &table->ACPIState.levels[0].vddc);
  1843.                 if (!ret) {
  1844.                         u16 std_vddc;
  1845.  
  1846.                         ret = ni_get_std_voltage_value(rdev,
  1847.                                                        &table->ACPIState.levels[0].vddc,
  1848.                                                        &std_vddc);
  1849.                         if (!ret)
  1850.                                 ni_populate_std_voltage_value(rdev, std_vddc,
  1851.                                                               table->ACPIState.levels[0].vddc.index,
  1852.                                                               &table->ACPIState.levels[0].std_vddc);
  1853.                 }
  1854.                 table->ACPIState.levels[0].gen2PCIE = 0;
  1855.         }
  1856.  
  1857.         if (eg_pi->acpi_vddci) {
  1858.                 if (eg_pi->vddci_control)
  1859.                         ni_populate_voltage_value(rdev,
  1860.                                                   &eg_pi->vddci_voltage_table,
  1861.                                                   eg_pi->acpi_vddci,
  1862.                                                   &table->ACPIState.levels[0].vddci);
  1863.         }
  1864.  
  1865.  
  1866.         mpll_ad_func_cntl &= ~PDNB;
  1867.  
  1868.         mpll_ad_func_cntl_2 |= BIAS_GEN_PDNB | RESET_EN;
  1869.  
  1870.         if (pi->mem_gddr5)
  1871.                 mpll_dq_func_cntl &= ~PDNB;
  1872.         mpll_dq_func_cntl_2 |= BIAS_GEN_PDNB | RESET_EN | BYPASS;
  1873.  
  1874.  
  1875.         mclk_pwrmgt_cntl |= (MRDCKA0_RESET |
  1876.                              MRDCKA1_RESET |
  1877.                              MRDCKB0_RESET |
  1878.                              MRDCKB1_RESET |
  1879.                              MRDCKC0_RESET |
  1880.                              MRDCKC1_RESET |
  1881.                              MRDCKD0_RESET |
  1882.                              MRDCKD1_RESET);
  1883.  
  1884.         mclk_pwrmgt_cntl &= ~(MRDCKA0_PDNB |
  1885.                               MRDCKA1_PDNB |
  1886.                               MRDCKB0_PDNB |
  1887.                               MRDCKB1_PDNB |
  1888.                               MRDCKC0_PDNB |
  1889.                               MRDCKC1_PDNB |
  1890.                               MRDCKD0_PDNB |
  1891.                               MRDCKD1_PDNB);
  1892.  
  1893.         dll_cntl |= (MRDCKA0_BYPASS |
  1894.                      MRDCKA1_BYPASS |
  1895.                      MRDCKB0_BYPASS |
  1896.                      MRDCKB1_BYPASS |
  1897.                      MRDCKC0_BYPASS |
  1898.                      MRDCKC1_BYPASS |
  1899.                      MRDCKD0_BYPASS |
  1900.                      MRDCKD1_BYPASS);
  1901.  
  1902.         spll_func_cntl_2 &= ~SCLK_MUX_SEL_MASK;
  1903.         spll_func_cntl_2 |= SCLK_MUX_SEL(4);
  1904.  
  1905.         table->ACPIState.levels[0].mclk.vMPLL_AD_FUNC_CNTL = cpu_to_be32(mpll_ad_func_cntl);
  1906.         table->ACPIState.levels[0].mclk.vMPLL_AD_FUNC_CNTL_2 = cpu_to_be32(mpll_ad_func_cntl_2);
  1907.         table->ACPIState.levels[0].mclk.vMPLL_DQ_FUNC_CNTL = cpu_to_be32(mpll_dq_func_cntl);
  1908.         table->ACPIState.levels[0].mclk.vMPLL_DQ_FUNC_CNTL_2 = cpu_to_be32(mpll_dq_func_cntl_2);
  1909.         table->ACPIState.levels[0].mclk.vMCLK_PWRMGT_CNTL = cpu_to_be32(mclk_pwrmgt_cntl);
  1910.         table->ACPIState.levels[0].mclk.vDLL_CNTL = cpu_to_be32(dll_cntl);
  1911.  
  1912.         table->ACPIState.levels[0].mclk.mclk_value = 0;
  1913.  
  1914.         table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL = cpu_to_be32(spll_func_cntl);
  1915.         table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_2 = cpu_to_be32(spll_func_cntl_2);
  1916.         table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_3 = cpu_to_be32(spll_func_cntl_3);
  1917.         table->ACPIState.levels[0].sclk.vCG_SPLL_FUNC_CNTL_4 = cpu_to_be32(spll_func_cntl_4);
  1918.  
  1919.         table->ACPIState.levels[0].sclk.sclk_value = 0;
  1920.  
  1921.         ni_populate_mvdd_value(rdev, 0, &table->ACPIState.levels[0].mvdd);
  1922.  
  1923.         if (eg_pi->dynamic_ac_timing)
  1924.                 table->ACPIState.levels[0].ACIndex = 1;
  1925.  
  1926.         table->ACPIState.levels[0].dpm2.MaxPS = 0;
  1927.         table->ACPIState.levels[0].dpm2.NearTDPDec = 0;
  1928.         table->ACPIState.levels[0].dpm2.AboveSafeInc = 0;
  1929.         table->ACPIState.levels[0].dpm2.BelowSafeInc = 0;
  1930.  
  1931.         reg = MIN_POWER_MASK | MAX_POWER_MASK;
  1932.         table->ACPIState.levels[0].SQPowerThrottle = cpu_to_be32(reg);
  1933.  
  1934.         reg = MAX_POWER_DELTA_MASK | STI_SIZE_MASK | LTI_RATIO_MASK;
  1935.         table->ACPIState.levels[0].SQPowerThrottle_2 = cpu_to_be32(reg);
  1936.  
  1937.         return 0;
  1938. }
  1939.  
  1940. static int ni_init_smc_table(struct radeon_device *rdev)
  1941. {
  1942.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  1943.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  1944.         int ret;
  1945.         struct radeon_ps *radeon_boot_state = rdev->pm.dpm.boot_ps;
  1946.         NISLANDS_SMC_STATETABLE *table = &ni_pi->smc_statetable;
  1947.  
  1948.         memset(table, 0, sizeof(NISLANDS_SMC_STATETABLE));
  1949.  
  1950.         ni_populate_smc_voltage_tables(rdev, table);
  1951.  
  1952.         switch (rdev->pm.int_thermal_type) {
  1953.         case THERMAL_TYPE_NI:
  1954.         case THERMAL_TYPE_EMC2103_WITH_INTERNAL:
  1955.                 table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_INTERNAL;
  1956.                 break;
  1957.         case THERMAL_TYPE_NONE:
  1958.                 table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_NONE;
  1959.                 break;
  1960.         default:
  1961.                 table->thermalProtectType = PPSMC_THERMAL_PROTECT_TYPE_EXTERNAL;
  1962.                 break;
  1963.         }
  1964.  
  1965.         if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_HARDWAREDC)
  1966.                 table->systemFlags |= PPSMC_SYSTEMFLAG_GPIO_DC;
  1967.  
  1968.         if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_REGULATOR_HOT)
  1969.                 table->systemFlags |= PPSMC_SYSTEMFLAG_REGULATOR_HOT;
  1970.  
  1971.         if (rdev->pm.dpm.platform_caps & ATOM_PP_PLATFORM_CAP_STEPVDDC)
  1972.                 table->systemFlags |= PPSMC_SYSTEMFLAG_STEPVDDC;
  1973.  
  1974.         if (pi->mem_gddr5)
  1975.                 table->systemFlags |= PPSMC_SYSTEMFLAG_GDDR5;
  1976.  
  1977.         ret = ni_populate_smc_initial_state(rdev, radeon_boot_state, table);
  1978.         if (ret)
  1979.                 return ret;
  1980.  
  1981.         ret = ni_populate_smc_acpi_state(rdev, table);
  1982.         if (ret)
  1983.                 return ret;
  1984.  
  1985.         table->driverState = table->initialState;
  1986.  
  1987.         table->ULVState = table->initialState;
  1988.  
  1989.         ret = ni_do_program_memory_timing_parameters(rdev, radeon_boot_state,
  1990.                                                      NISLANDS_INITIAL_STATE_ARB_INDEX);
  1991.         if (ret)
  1992.                 return ret;
  1993.  
  1994.         return rv770_copy_bytes_to_smc(rdev, pi->state_table_start, (u8 *)table,
  1995.                                        sizeof(NISLANDS_SMC_STATETABLE), pi->sram_end);
  1996. }
  1997.  
  1998. static int ni_calculate_sclk_params(struct radeon_device *rdev,
  1999.                                     u32 engine_clock,
  2000.                                     NISLANDS_SMC_SCLK_VALUE *sclk)
  2001. {
  2002.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2003.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2004.         struct atom_clock_dividers dividers;
  2005.         u32 spll_func_cntl = ni_pi->clock_registers.cg_spll_func_cntl;
  2006.         u32 spll_func_cntl_2 = ni_pi->clock_registers.cg_spll_func_cntl_2;
  2007.         u32 spll_func_cntl_3 = ni_pi->clock_registers.cg_spll_func_cntl_3;
  2008.         u32 spll_func_cntl_4 = ni_pi->clock_registers.cg_spll_func_cntl_4;
  2009.         u32 cg_spll_spread_spectrum = ni_pi->clock_registers.cg_spll_spread_spectrum;
  2010.         u32 cg_spll_spread_spectrum_2 = ni_pi->clock_registers.cg_spll_spread_spectrum_2;
  2011.         u64 tmp;
  2012.         u32 reference_clock = rdev->clock.spll.reference_freq;
  2013.         u32 reference_divider;
  2014.         u32 fbdiv;
  2015.         int ret;
  2016.  
  2017.         ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
  2018.                                              engine_clock, false, &dividers);
  2019.         if (ret)
  2020.                 return ret;
  2021.  
  2022.         reference_divider = 1 + dividers.ref_div;
  2023.  
  2024.  
  2025.         tmp = (u64) engine_clock * reference_divider * dividers.post_div * 16834;
  2026.         do_div(tmp, reference_clock);
  2027.         fbdiv = (u32) tmp;
  2028.  
  2029.         spll_func_cntl &= ~(SPLL_PDIV_A_MASK | SPLL_REF_DIV_MASK);
  2030.         spll_func_cntl |= SPLL_REF_DIV(dividers.ref_div);
  2031.         spll_func_cntl |= SPLL_PDIV_A(dividers.post_div);
  2032.  
  2033.         spll_func_cntl_2 &= ~SCLK_MUX_SEL_MASK;
  2034.         spll_func_cntl_2 |= SCLK_MUX_SEL(2);
  2035.  
  2036.         spll_func_cntl_3 &= ~SPLL_FB_DIV_MASK;
  2037.         spll_func_cntl_3 |= SPLL_FB_DIV(fbdiv);
  2038.         spll_func_cntl_3 |= SPLL_DITHEN;
  2039.  
  2040.         if (pi->sclk_ss) {
  2041.                 struct radeon_atom_ss ss;
  2042.                 u32 vco_freq = engine_clock * dividers.post_div;
  2043.  
  2044.                 if (radeon_atombios_get_asic_ss_info(rdev, &ss,
  2045.                                                      ASIC_INTERNAL_ENGINE_SS, vco_freq)) {
  2046.                         u32 clk_s = reference_clock * 5 / (reference_divider * ss.rate);
  2047.                         u32 clk_v = 4 * ss.percentage * fbdiv / (clk_s * 10000);
  2048.  
  2049.                         cg_spll_spread_spectrum &= ~CLK_S_MASK;
  2050.                         cg_spll_spread_spectrum |= CLK_S(clk_s);
  2051.                         cg_spll_spread_spectrum |= SSEN;
  2052.  
  2053.                         cg_spll_spread_spectrum_2 &= ~CLK_V_MASK;
  2054.                         cg_spll_spread_spectrum_2 |= CLK_V(clk_v);
  2055.                 }
  2056.         }
  2057.  
  2058.         sclk->sclk_value = engine_clock;
  2059.         sclk->vCG_SPLL_FUNC_CNTL = spll_func_cntl;
  2060.         sclk->vCG_SPLL_FUNC_CNTL_2 = spll_func_cntl_2;
  2061.         sclk->vCG_SPLL_FUNC_CNTL_3 = spll_func_cntl_3;
  2062.         sclk->vCG_SPLL_FUNC_CNTL_4 = spll_func_cntl_4;
  2063.         sclk->vCG_SPLL_SPREAD_SPECTRUM = cg_spll_spread_spectrum;
  2064.         sclk->vCG_SPLL_SPREAD_SPECTRUM_2 = cg_spll_spread_spectrum_2;
  2065.  
  2066.         return 0;
  2067. }
  2068.  
  2069. static int ni_populate_sclk_value(struct radeon_device *rdev,
  2070.                                   u32 engine_clock,
  2071.                                   NISLANDS_SMC_SCLK_VALUE *sclk)
  2072. {
  2073.         NISLANDS_SMC_SCLK_VALUE sclk_tmp;
  2074.         int ret;
  2075.  
  2076.         ret = ni_calculate_sclk_params(rdev, engine_clock, &sclk_tmp);
  2077.         if (!ret) {
  2078.                 sclk->sclk_value = cpu_to_be32(sclk_tmp.sclk_value);
  2079.                 sclk->vCG_SPLL_FUNC_CNTL = cpu_to_be32(sclk_tmp.vCG_SPLL_FUNC_CNTL);
  2080.                 sclk->vCG_SPLL_FUNC_CNTL_2 = cpu_to_be32(sclk_tmp.vCG_SPLL_FUNC_CNTL_2);
  2081.                 sclk->vCG_SPLL_FUNC_CNTL_3 = cpu_to_be32(sclk_tmp.vCG_SPLL_FUNC_CNTL_3);
  2082.                 sclk->vCG_SPLL_FUNC_CNTL_4 = cpu_to_be32(sclk_tmp.vCG_SPLL_FUNC_CNTL_4);
  2083.                 sclk->vCG_SPLL_SPREAD_SPECTRUM = cpu_to_be32(sclk_tmp.vCG_SPLL_SPREAD_SPECTRUM);
  2084.                 sclk->vCG_SPLL_SPREAD_SPECTRUM_2 = cpu_to_be32(sclk_tmp.vCG_SPLL_SPREAD_SPECTRUM_2);
  2085.         }
  2086.  
  2087.         return ret;
  2088. }
  2089.  
  2090. static int ni_init_smc_spll_table(struct radeon_device *rdev)
  2091. {
  2092.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2093.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2094.         SMC_NISLANDS_SPLL_DIV_TABLE *spll_table;
  2095.         NISLANDS_SMC_SCLK_VALUE sclk_params;
  2096.         u32 fb_div;
  2097.         u32 p_div;
  2098.         u32 clk_s;
  2099.         u32 clk_v;
  2100.         u32 sclk = 0;
  2101.         int i, ret;
  2102.         u32 tmp;
  2103.  
  2104.         if (ni_pi->spll_table_start == 0)
  2105.                 return -EINVAL;
  2106.  
  2107.         spll_table = kzalloc(sizeof(SMC_NISLANDS_SPLL_DIV_TABLE), GFP_KERNEL);
  2108.         if (spll_table == NULL)
  2109.                 return -ENOMEM;
  2110.  
  2111.         for (i = 0; i < 256; i++) {
  2112.                 ret = ni_calculate_sclk_params(rdev, sclk, &sclk_params);
  2113.                 if (ret)
  2114.                         break;
  2115.  
  2116.                 p_div = (sclk_params.vCG_SPLL_FUNC_CNTL & SPLL_PDIV_A_MASK) >> SPLL_PDIV_A_SHIFT;
  2117.                 fb_div = (sclk_params.vCG_SPLL_FUNC_CNTL_3 & SPLL_FB_DIV_MASK) >> SPLL_FB_DIV_SHIFT;
  2118.                 clk_s = (sclk_params.vCG_SPLL_SPREAD_SPECTRUM & CLK_S_MASK) >> CLK_S_SHIFT;
  2119.                 clk_v = (sclk_params.vCG_SPLL_SPREAD_SPECTRUM_2 & CLK_V_MASK) >> CLK_V_SHIFT;
  2120.  
  2121.                 fb_div &= ~0x00001FFF;
  2122.                 fb_div >>= 1;
  2123.                 clk_v >>= 6;
  2124.  
  2125.                 if (p_div & ~(SMC_NISLANDS_SPLL_DIV_TABLE_PDIV_MASK >> SMC_NISLANDS_SPLL_DIV_TABLE_PDIV_SHIFT))
  2126.                         ret = -EINVAL;
  2127.  
  2128.                 if (clk_s & ~(SMC_NISLANDS_SPLL_DIV_TABLE_CLKS_MASK >> SMC_NISLANDS_SPLL_DIV_TABLE_CLKS_SHIFT))
  2129.                         ret = -EINVAL;
  2130.  
  2131.                 if (clk_s & ~(SMC_NISLANDS_SPLL_DIV_TABLE_CLKS_MASK >> SMC_NISLANDS_SPLL_DIV_TABLE_CLKS_SHIFT))
  2132.                         ret = -EINVAL;
  2133.  
  2134.                 if (clk_v & ~(SMC_NISLANDS_SPLL_DIV_TABLE_CLKV_MASK >> SMC_NISLANDS_SPLL_DIV_TABLE_CLKV_SHIFT))
  2135.                         ret = -EINVAL;
  2136.  
  2137.                 if (ret)
  2138.                         break;
  2139.  
  2140.                 tmp = ((fb_div << SMC_NISLANDS_SPLL_DIV_TABLE_FBDIV_SHIFT) & SMC_NISLANDS_SPLL_DIV_TABLE_FBDIV_MASK) |
  2141.                         ((p_div << SMC_NISLANDS_SPLL_DIV_TABLE_PDIV_SHIFT) & SMC_NISLANDS_SPLL_DIV_TABLE_PDIV_MASK);
  2142.                 spll_table->freq[i] = cpu_to_be32(tmp);
  2143.  
  2144.                 tmp = ((clk_v << SMC_NISLANDS_SPLL_DIV_TABLE_CLKV_SHIFT) & SMC_NISLANDS_SPLL_DIV_TABLE_CLKV_MASK) |
  2145.                         ((clk_s << SMC_NISLANDS_SPLL_DIV_TABLE_CLKS_SHIFT) & SMC_NISLANDS_SPLL_DIV_TABLE_CLKS_MASK);
  2146.                 spll_table->ss[i] = cpu_to_be32(tmp);
  2147.  
  2148.                 sclk += 512;
  2149.         }
  2150.  
  2151.         if (!ret)
  2152.                 ret = rv770_copy_bytes_to_smc(rdev, ni_pi->spll_table_start, (u8 *)spll_table,
  2153.                                               sizeof(SMC_NISLANDS_SPLL_DIV_TABLE), pi->sram_end);
  2154.  
  2155.         kfree(spll_table);
  2156.  
  2157.         return ret;
  2158. }
  2159.  
  2160. static int ni_populate_mclk_value(struct radeon_device *rdev,
  2161.                                   u32 engine_clock,
  2162.                                   u32 memory_clock,
  2163.                                   NISLANDS_SMC_MCLK_VALUE *mclk,
  2164.                                   bool strobe_mode,
  2165.                                   bool dll_state_on)
  2166. {
  2167.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2168.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2169.         u32 mpll_ad_func_cntl = ni_pi->clock_registers.mpll_ad_func_cntl;
  2170.         u32 mpll_ad_func_cntl_2 = ni_pi->clock_registers.mpll_ad_func_cntl_2;
  2171.         u32 mpll_dq_func_cntl = ni_pi->clock_registers.mpll_dq_func_cntl;
  2172.         u32 mpll_dq_func_cntl_2 = ni_pi->clock_registers.mpll_dq_func_cntl_2;
  2173.         u32 mclk_pwrmgt_cntl = ni_pi->clock_registers.mclk_pwrmgt_cntl;
  2174.         u32 dll_cntl = ni_pi->clock_registers.dll_cntl;
  2175.         u32 mpll_ss1 = ni_pi->clock_registers.mpll_ss1;
  2176.         u32 mpll_ss2 = ni_pi->clock_registers.mpll_ss2;
  2177.         struct atom_clock_dividers dividers;
  2178.         u32 ibias;
  2179.         u32 dll_speed;
  2180.         int ret;
  2181.         u32 mc_seq_misc7;
  2182.  
  2183.         ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_MEMORY_PLL_PARAM,
  2184.                                              memory_clock, strobe_mode, &dividers);
  2185.         if (ret)
  2186.                 return ret;
  2187.  
  2188.         if (!strobe_mode) {
  2189.                 mc_seq_misc7 = RREG32(MC_SEQ_MISC7);
  2190.  
  2191.                 if (mc_seq_misc7 & 0x8000000)
  2192.                         dividers.post_div = 1;
  2193.         }
  2194.  
  2195.         ibias = cypress_map_clkf_to_ibias(rdev, dividers.whole_fb_div);
  2196.  
  2197.         mpll_ad_func_cntl &= ~(CLKR_MASK |
  2198.                                YCLK_POST_DIV_MASK |
  2199.                                CLKF_MASK |
  2200.                                CLKFRAC_MASK |
  2201.                                IBIAS_MASK);
  2202.         mpll_ad_func_cntl |= CLKR(dividers.ref_div);
  2203.         mpll_ad_func_cntl |= YCLK_POST_DIV(dividers.post_div);
  2204.         mpll_ad_func_cntl |= CLKF(dividers.whole_fb_div);
  2205.         mpll_ad_func_cntl |= CLKFRAC(dividers.frac_fb_div);
  2206.         mpll_ad_func_cntl |= IBIAS(ibias);
  2207.  
  2208.         if (dividers.vco_mode)
  2209.                 mpll_ad_func_cntl_2 |= VCO_MODE;
  2210.         else
  2211.                 mpll_ad_func_cntl_2 &= ~VCO_MODE;
  2212.  
  2213.         if (pi->mem_gddr5) {
  2214.                 mpll_dq_func_cntl &= ~(CLKR_MASK |
  2215.                                        YCLK_POST_DIV_MASK |
  2216.                                        CLKF_MASK |
  2217.                                        CLKFRAC_MASK |
  2218.                                        IBIAS_MASK);
  2219.                 mpll_dq_func_cntl |= CLKR(dividers.ref_div);
  2220.                 mpll_dq_func_cntl |= YCLK_POST_DIV(dividers.post_div);
  2221.                 mpll_dq_func_cntl |= CLKF(dividers.whole_fb_div);
  2222.                 mpll_dq_func_cntl |= CLKFRAC(dividers.frac_fb_div);
  2223.                 mpll_dq_func_cntl |= IBIAS(ibias);
  2224.  
  2225.                 if (strobe_mode)
  2226.                         mpll_dq_func_cntl &= ~PDNB;
  2227.                 else
  2228.                         mpll_dq_func_cntl |= PDNB;
  2229.  
  2230.                 if (dividers.vco_mode)
  2231.                         mpll_dq_func_cntl_2 |= VCO_MODE;
  2232.                 else
  2233.                         mpll_dq_func_cntl_2 &= ~VCO_MODE;
  2234.         }
  2235.  
  2236.         if (pi->mclk_ss) {
  2237.                 struct radeon_atom_ss ss;
  2238.                 u32 vco_freq = memory_clock * dividers.post_div;
  2239.  
  2240.                 if (radeon_atombios_get_asic_ss_info(rdev, &ss,
  2241.                                                      ASIC_INTERNAL_MEMORY_SS, vco_freq)) {
  2242.                         u32 reference_clock = rdev->clock.mpll.reference_freq;
  2243.                         u32 decoded_ref = rv740_get_decoded_reference_divider(dividers.ref_div);
  2244.                         u32 clk_s = reference_clock * 5 / (decoded_ref * ss.rate);
  2245.                         u32 clk_v = ss.percentage *
  2246.                                 (0x4000 * dividers.whole_fb_div + 0x800 * dividers.frac_fb_div) / (clk_s * 625);
  2247.  
  2248.                         mpll_ss1 &= ~CLKV_MASK;
  2249.                         mpll_ss1 |= CLKV(clk_v);
  2250.  
  2251.                         mpll_ss2 &= ~CLKS_MASK;
  2252.                         mpll_ss2 |= CLKS(clk_s);
  2253.                 }
  2254.         }
  2255.  
  2256.         dll_speed = rv740_get_dll_speed(pi->mem_gddr5,
  2257.                                         memory_clock);
  2258.  
  2259.         mclk_pwrmgt_cntl &= ~DLL_SPEED_MASK;
  2260.         mclk_pwrmgt_cntl |= DLL_SPEED(dll_speed);
  2261.         if (dll_state_on)
  2262.                 mclk_pwrmgt_cntl |= (MRDCKA0_PDNB |
  2263.                                      MRDCKA1_PDNB |
  2264.                                      MRDCKB0_PDNB |
  2265.                                      MRDCKB1_PDNB |
  2266.                                      MRDCKC0_PDNB |
  2267.                                      MRDCKC1_PDNB |
  2268.                                      MRDCKD0_PDNB |
  2269.                                      MRDCKD1_PDNB);
  2270.         else
  2271.                 mclk_pwrmgt_cntl &= ~(MRDCKA0_PDNB |
  2272.                                       MRDCKA1_PDNB |
  2273.                                       MRDCKB0_PDNB |
  2274.                                       MRDCKB1_PDNB |
  2275.                                       MRDCKC0_PDNB |
  2276.                                       MRDCKC1_PDNB |
  2277.                                       MRDCKD0_PDNB |
  2278.                                       MRDCKD1_PDNB);
  2279.  
  2280.  
  2281.         mclk->mclk_value = cpu_to_be32(memory_clock);
  2282.         mclk->vMPLL_AD_FUNC_CNTL = cpu_to_be32(mpll_ad_func_cntl);
  2283.         mclk->vMPLL_AD_FUNC_CNTL_2 = cpu_to_be32(mpll_ad_func_cntl_2);
  2284.         mclk->vMPLL_DQ_FUNC_CNTL = cpu_to_be32(mpll_dq_func_cntl);
  2285.         mclk->vMPLL_DQ_FUNC_CNTL_2 = cpu_to_be32(mpll_dq_func_cntl_2);
  2286.         mclk->vMCLK_PWRMGT_CNTL = cpu_to_be32(mclk_pwrmgt_cntl);
  2287.         mclk->vDLL_CNTL = cpu_to_be32(dll_cntl);
  2288.         mclk->vMPLL_SS = cpu_to_be32(mpll_ss1);
  2289.         mclk->vMPLL_SS2 = cpu_to_be32(mpll_ss2);
  2290.  
  2291.         return 0;
  2292. }
  2293.  
  2294. static void ni_populate_smc_sp(struct radeon_device *rdev,
  2295.                                struct radeon_ps *radeon_state,
  2296.                                NISLANDS_SMC_SWSTATE *smc_state)
  2297. {
  2298.         struct ni_ps *ps = ni_get_ps(radeon_state);
  2299.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2300.         int i;
  2301.  
  2302.         for (i = 0; i < ps->performance_level_count - 1; i++)
  2303.                 smc_state->levels[i].bSP = cpu_to_be32(pi->dsp);
  2304.  
  2305.         smc_state->levels[ps->performance_level_count - 1].bSP =
  2306.                 cpu_to_be32(pi->psp);
  2307. }
  2308.  
  2309. static int ni_convert_power_level_to_smc(struct radeon_device *rdev,
  2310.                                          struct rv7xx_pl *pl,
  2311.                                          NISLANDS_SMC_HW_PERFORMANCE_LEVEL *level)
  2312. {
  2313.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2314.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  2315.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2316.         int ret;
  2317.         bool dll_state_on;
  2318.         u16 std_vddc;
  2319.         u32 tmp = RREG32(DC_STUTTER_CNTL);
  2320.  
  2321.         level->gen2PCIE = pi->pcie_gen2 ?
  2322.                 ((pl->flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2) ? 1 : 0) : 0;
  2323.  
  2324.         ret = ni_populate_sclk_value(rdev, pl->sclk, &level->sclk);
  2325.         if (ret)
  2326.                 return ret;
  2327.  
  2328.         level->mcFlags =  0;
  2329.         if (pi->mclk_stutter_mode_threshold &&
  2330.             (pl->mclk <= pi->mclk_stutter_mode_threshold) &&
  2331.             !eg_pi->uvd_enabled &&
  2332.             (tmp & DC_STUTTER_ENABLE_A) &&
  2333.             (tmp & DC_STUTTER_ENABLE_B))
  2334.                 level->mcFlags |= NISLANDS_SMC_MC_STUTTER_EN;
  2335.  
  2336.         if (pi->mem_gddr5) {
  2337.                 if (pl->mclk > pi->mclk_edc_enable_threshold)
  2338.                         level->mcFlags |= NISLANDS_SMC_MC_EDC_RD_FLAG;
  2339.                 if (pl->mclk > eg_pi->mclk_edc_wr_enable_threshold)
  2340.                         level->mcFlags |= NISLANDS_SMC_MC_EDC_WR_FLAG;
  2341.  
  2342.                 level->strobeMode = cypress_get_strobe_mode_settings(rdev, pl->mclk);
  2343.  
  2344.                 if (level->strobeMode & NISLANDS_SMC_STROBE_ENABLE) {
  2345.                         if (cypress_get_mclk_frequency_ratio(rdev, pl->mclk, true) >=
  2346.                             ((RREG32(MC_SEQ_MISC7) >> 16) & 0xf))
  2347.                                 dll_state_on = ((RREG32(MC_SEQ_MISC5) >> 1) & 0x1) ? true : false;
  2348.                         else
  2349.                                 dll_state_on = ((RREG32(MC_SEQ_MISC6) >> 1) & 0x1) ? true : false;
  2350.                 } else {
  2351.                         dll_state_on = false;
  2352.                         if (pl->mclk > ni_pi->mclk_rtt_mode_threshold)
  2353.                                 level->mcFlags |= NISLANDS_SMC_MC_RTT_ENABLE;
  2354.                 }
  2355.  
  2356.                 ret = ni_populate_mclk_value(rdev, pl->sclk, pl->mclk,
  2357.                                              &level->mclk,
  2358.                                              (level->strobeMode & NISLANDS_SMC_STROBE_ENABLE) != 0,
  2359.                                              dll_state_on);
  2360.         } else
  2361.                 ret = ni_populate_mclk_value(rdev, pl->sclk, pl->mclk, &level->mclk, 1, 1);
  2362.  
  2363.         if (ret)
  2364.                 return ret;
  2365.  
  2366.         ret = ni_populate_voltage_value(rdev, &eg_pi->vddc_voltage_table,
  2367.                                         pl->vddc, &level->vddc);
  2368.         if (ret)
  2369.                 return ret;
  2370.  
  2371.         ret = ni_get_std_voltage_value(rdev, &level->vddc, &std_vddc);
  2372.         if (ret)
  2373.                 return ret;
  2374.  
  2375.         ni_populate_std_voltage_value(rdev, std_vddc,
  2376.                                       level->vddc.index, &level->std_vddc);
  2377.  
  2378.         if (eg_pi->vddci_control) {
  2379.                 ret = ni_populate_voltage_value(rdev, &eg_pi->vddci_voltage_table,
  2380.                                                 pl->vddci, &level->vddci);
  2381.                 if (ret)
  2382.                         return ret;
  2383.         }
  2384.  
  2385.         ni_populate_mvdd_value(rdev, pl->mclk, &level->mvdd);
  2386.  
  2387.         return ret;
  2388. }
  2389.  
  2390. static int ni_populate_smc_t(struct radeon_device *rdev,
  2391.                              struct radeon_ps *radeon_state,
  2392.                              NISLANDS_SMC_SWSTATE *smc_state)
  2393. {
  2394.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2395.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  2396.         struct ni_ps *state = ni_get_ps(radeon_state);
  2397.         u32 a_t;
  2398.         u32 t_l, t_h;
  2399.         u32 high_bsp;
  2400.         int i, ret;
  2401.  
  2402.         if (state->performance_level_count >= 9)
  2403.                 return -EINVAL;
  2404.  
  2405.         if (state->performance_level_count < 2) {
  2406.                 a_t = CG_R(0xffff) | CG_L(0);
  2407.                 smc_state->levels[0].aT = cpu_to_be32(a_t);
  2408.                 return 0;
  2409.         }
  2410.  
  2411.         smc_state->levels[0].aT = cpu_to_be32(0);
  2412.  
  2413.         for (i = 0; i <= state->performance_level_count - 2; i++) {
  2414.                 if (eg_pi->uvd_enabled)
  2415.                         ret = r600_calculate_at(
  2416.                                 1000 * (i * (eg_pi->smu_uvd_hs ? 2 : 8) + 2),
  2417.                                 100 * R600_AH_DFLT,
  2418.                                 state->performance_levels[i + 1].sclk,
  2419.                                 state->performance_levels[i].sclk,
  2420.                                 &t_l,
  2421.                                 &t_h);
  2422.                 else
  2423.                         ret = r600_calculate_at(
  2424.                                 1000 * (i + 1),
  2425.                                 100 * R600_AH_DFLT,
  2426.                                 state->performance_levels[i + 1].sclk,
  2427.                                 state->performance_levels[i].sclk,
  2428.                                 &t_l,
  2429.                                 &t_h);
  2430.  
  2431.                 if (ret) {
  2432.                         t_h = (i + 1) * 1000 - 50 * R600_AH_DFLT;
  2433.                         t_l = (i + 1) * 1000 + 50 * R600_AH_DFLT;
  2434.                 }
  2435.  
  2436.                 a_t = be32_to_cpu(smc_state->levels[i].aT) & ~CG_R_MASK;
  2437.                 a_t |= CG_R(t_l * pi->bsp / 20000);
  2438.                 smc_state->levels[i].aT = cpu_to_be32(a_t);
  2439.  
  2440.                 high_bsp = (i == state->performance_level_count - 2) ?
  2441.                         pi->pbsp : pi->bsp;
  2442.  
  2443.                 a_t = CG_R(0xffff) | CG_L(t_h * high_bsp / 20000);
  2444.                 smc_state->levels[i + 1].aT = cpu_to_be32(a_t);
  2445.         }
  2446.  
  2447.         return 0;
  2448. }
  2449.  
  2450. static int ni_populate_power_containment_values(struct radeon_device *rdev,
  2451.                                                 struct radeon_ps *radeon_state,
  2452.                                                 NISLANDS_SMC_SWSTATE *smc_state)
  2453. {
  2454.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2455.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  2456.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2457.         struct ni_ps *state = ni_get_ps(radeon_state);
  2458.         u32 prev_sclk;
  2459.         u32 max_sclk;
  2460.         u32 min_sclk;
  2461.         int i, ret;
  2462.         u32 tdp_limit;
  2463.         u32 near_tdp_limit;
  2464.         u32 power_boost_limit;
  2465.         u8 max_ps_percent;
  2466.  
  2467.         if (ni_pi->enable_power_containment == false)
  2468.                 return 0;
  2469.  
  2470.         if (state->performance_level_count == 0)
  2471.                 return -EINVAL;
  2472.  
  2473.         if (smc_state->levelCount != state->performance_level_count)
  2474.                 return -EINVAL;
  2475.  
  2476.         ret = ni_calculate_adjusted_tdp_limits(rdev,
  2477.                                                false, /* ??? */
  2478.                                                rdev->pm.dpm.tdp_adjustment,
  2479.                                                &tdp_limit,
  2480.                                                &near_tdp_limit);
  2481.         if (ret)
  2482.                 return ret;
  2483.  
  2484.         power_boost_limit = ni_calculate_power_boost_limit(rdev, radeon_state, near_tdp_limit);
  2485.  
  2486.         ret = rv770_write_smc_sram_dword(rdev,
  2487.                                          pi->state_table_start +
  2488.                                          offsetof(NISLANDS_SMC_STATETABLE, dpm2Params) +
  2489.                                          offsetof(PP_NIslands_DPM2Parameters, PowerBoostLimit),
  2490.                                          ni_scale_power_for_smc(power_boost_limit, ni_get_smc_power_scaling_factor(rdev)),
  2491.                                          pi->sram_end);
  2492.         if (ret)
  2493.                 power_boost_limit = 0;
  2494.  
  2495.         smc_state->levels[0].dpm2.MaxPS = 0;
  2496.         smc_state->levels[0].dpm2.NearTDPDec = 0;
  2497.         smc_state->levels[0].dpm2.AboveSafeInc = 0;
  2498.         smc_state->levels[0].dpm2.BelowSafeInc = 0;
  2499.         smc_state->levels[0].stateFlags |= power_boost_limit ? PPSMC_STATEFLAG_POWERBOOST : 0;
  2500.  
  2501.         for (i = 1; i < state->performance_level_count; i++) {
  2502.                 prev_sclk = state->performance_levels[i-1].sclk;
  2503.                 max_sclk  = state->performance_levels[i].sclk;
  2504.                 max_ps_percent = (i != (state->performance_level_count - 1)) ?
  2505.                         NISLANDS_DPM2_MAXPS_PERCENT_M : NISLANDS_DPM2_MAXPS_PERCENT_H;
  2506.  
  2507.                 if (max_sclk < prev_sclk)
  2508.                         return -EINVAL;
  2509.  
  2510.                 if ((max_ps_percent == 0) || (prev_sclk == max_sclk) || eg_pi->uvd_enabled)
  2511.                         min_sclk = max_sclk;
  2512.                 else if (1 == i)
  2513.                         min_sclk = prev_sclk;
  2514.                 else
  2515.                         min_sclk = (prev_sclk * (u32)max_ps_percent) / 100;
  2516.  
  2517.                 if (min_sclk < state->performance_levels[0].sclk)
  2518.                         min_sclk = state->performance_levels[0].sclk;
  2519.  
  2520.                 if (min_sclk == 0)
  2521.                         return -EINVAL;
  2522.  
  2523.                 smc_state->levels[i].dpm2.MaxPS =
  2524.                         (u8)((NISLANDS_DPM2_MAX_PULSE_SKIP * (max_sclk - min_sclk)) / max_sclk);
  2525.                 smc_state->levels[i].dpm2.NearTDPDec = NISLANDS_DPM2_NEAR_TDP_DEC;
  2526.                 smc_state->levels[i].dpm2.AboveSafeInc = NISLANDS_DPM2_ABOVE_SAFE_INC;
  2527.                 smc_state->levels[i].dpm2.BelowSafeInc = NISLANDS_DPM2_BELOW_SAFE_INC;
  2528.                 smc_state->levels[i].stateFlags |=
  2529.                         ((i != (state->performance_level_count - 1)) && power_boost_limit) ?
  2530.                         PPSMC_STATEFLAG_POWERBOOST : 0;
  2531.         }
  2532.  
  2533.         return 0;
  2534. }
  2535.  
  2536. static int ni_populate_sq_ramping_values(struct radeon_device *rdev,
  2537.                                          struct radeon_ps *radeon_state,
  2538.                                          NISLANDS_SMC_SWSTATE *smc_state)
  2539. {
  2540.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2541.         struct ni_ps *state = ni_get_ps(radeon_state);
  2542.         u32 sq_power_throttle;
  2543.         u32 sq_power_throttle2;
  2544.         bool enable_sq_ramping = ni_pi->enable_sq_ramping;
  2545.         int i;
  2546.  
  2547.         if (state->performance_level_count == 0)
  2548.                 return -EINVAL;
  2549.  
  2550.         if (smc_state->levelCount != state->performance_level_count)
  2551.                 return -EINVAL;
  2552.  
  2553.         if (rdev->pm.dpm.sq_ramping_threshold == 0)
  2554.                 return -EINVAL;
  2555.  
  2556.         if (NISLANDS_DPM2_SQ_RAMP_MAX_POWER > (MAX_POWER_MASK >> MAX_POWER_SHIFT))
  2557.                 enable_sq_ramping = false;
  2558.  
  2559.         if (NISLANDS_DPM2_SQ_RAMP_MIN_POWER > (MIN_POWER_MASK >> MIN_POWER_SHIFT))
  2560.                 enable_sq_ramping = false;
  2561.  
  2562.         if (NISLANDS_DPM2_SQ_RAMP_MAX_POWER_DELTA > (MAX_POWER_DELTA_MASK >> MAX_POWER_DELTA_SHIFT))
  2563.                 enable_sq_ramping = false;
  2564.  
  2565.         if (NISLANDS_DPM2_SQ_RAMP_STI_SIZE > (STI_SIZE_MASK >> STI_SIZE_SHIFT))
  2566.                 enable_sq_ramping = false;
  2567.  
  2568.         if (NISLANDS_DPM2_SQ_RAMP_LTI_RATIO > (LTI_RATIO_MASK >> LTI_RATIO_SHIFT))
  2569.                 enable_sq_ramping = false;
  2570.  
  2571.         for (i = 0; i < state->performance_level_count; i++) {
  2572.                 sq_power_throttle  = 0;
  2573.                 sq_power_throttle2 = 0;
  2574.  
  2575.                 if ((state->performance_levels[i].sclk >= rdev->pm.dpm.sq_ramping_threshold) &&
  2576.                     enable_sq_ramping) {
  2577.                         sq_power_throttle |= MAX_POWER(NISLANDS_DPM2_SQ_RAMP_MAX_POWER);
  2578.                         sq_power_throttle |= MIN_POWER(NISLANDS_DPM2_SQ_RAMP_MIN_POWER);
  2579.                         sq_power_throttle2 |= MAX_POWER_DELTA(NISLANDS_DPM2_SQ_RAMP_MAX_POWER_DELTA);
  2580.                         sq_power_throttle2 |= STI_SIZE(NISLANDS_DPM2_SQ_RAMP_STI_SIZE);
  2581.                         sq_power_throttle2 |= LTI_RATIO(NISLANDS_DPM2_SQ_RAMP_LTI_RATIO);
  2582.                 } else {
  2583.                         sq_power_throttle |= MAX_POWER_MASK | MIN_POWER_MASK;
  2584.                         sq_power_throttle2 |= MAX_POWER_DELTA_MASK | STI_SIZE_MASK | LTI_RATIO_MASK;
  2585.                 }
  2586.  
  2587.                 smc_state->levels[i].SQPowerThrottle   = cpu_to_be32(sq_power_throttle);
  2588.                 smc_state->levels[i].SQPowerThrottle_2 = cpu_to_be32(sq_power_throttle2);
  2589.         }
  2590.  
  2591.         return 0;
  2592. }
  2593.  
  2594. static int ni_enable_power_containment(struct radeon_device *rdev,
  2595.                                        struct radeon_ps *radeon_new_state,
  2596.                                        bool enable)
  2597. {
  2598.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2599.         PPSMC_Result smc_result;
  2600.         int ret = 0;
  2601.  
  2602.         if (ni_pi->enable_power_containment) {
  2603.                 if (enable) {
  2604.                         if (!r600_is_uvd_state(radeon_new_state->class, radeon_new_state->class2)) {
  2605.                                 smc_result = rv770_send_msg_to_smc(rdev, PPSMC_TDPClampingActive);
  2606.                                 if (smc_result != PPSMC_Result_OK) {
  2607.                                         ret = -EINVAL;
  2608.                                         ni_pi->pc_enabled = false;
  2609.                                 } else {
  2610.                                         ni_pi->pc_enabled = true;
  2611.                                 }
  2612.                         }
  2613.                 } else {
  2614.                         smc_result = rv770_send_msg_to_smc(rdev, PPSMC_TDPClampingInactive);
  2615.                         if (smc_result != PPSMC_Result_OK)
  2616.                                 ret = -EINVAL;
  2617.                         ni_pi->pc_enabled = false;
  2618.                 }
  2619.         }
  2620.  
  2621.         return ret;
  2622. }
  2623.  
  2624. static int ni_convert_power_state_to_smc(struct radeon_device *rdev,
  2625.                                          struct radeon_ps *radeon_state,
  2626.                                          NISLANDS_SMC_SWSTATE *smc_state)
  2627. {
  2628.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  2629.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2630.         struct ni_ps *state = ni_get_ps(radeon_state);
  2631.         int i, ret;
  2632.         u32 threshold = state->performance_levels[state->performance_level_count - 1].sclk * 100 / 100;
  2633.  
  2634.         if (!(radeon_state->caps & ATOM_PPLIB_DISALLOW_ON_DC))
  2635.                 smc_state->flags |= PPSMC_SWSTATE_FLAG_DC;
  2636.  
  2637.         smc_state->levelCount = 0;
  2638.  
  2639.         if (state->performance_level_count > NISLANDS_MAX_SMC_PERFORMANCE_LEVELS_PER_SWSTATE)
  2640.                 return -EINVAL;
  2641.  
  2642.         for (i = 0; i < state->performance_level_count; i++) {
  2643.                 ret = ni_convert_power_level_to_smc(rdev, &state->performance_levels[i],
  2644.                                                     &smc_state->levels[i]);
  2645.                 smc_state->levels[i].arbRefreshState =
  2646.                         (u8)(NISLANDS_DRIVER_STATE_ARB_INDEX + i);
  2647.  
  2648.                 if (ret)
  2649.                         return ret;
  2650.  
  2651.                 if (ni_pi->enable_power_containment)
  2652.                         smc_state->levels[i].displayWatermark =
  2653.                                 (state->performance_levels[i].sclk < threshold) ?
  2654.                                 PPSMC_DISPLAY_WATERMARK_LOW : PPSMC_DISPLAY_WATERMARK_HIGH;
  2655.                 else
  2656.                         smc_state->levels[i].displayWatermark = (i < 2) ?
  2657.                                 PPSMC_DISPLAY_WATERMARK_LOW : PPSMC_DISPLAY_WATERMARK_HIGH;
  2658.  
  2659.                 if (eg_pi->dynamic_ac_timing)
  2660.                         smc_state->levels[i].ACIndex = NISLANDS_MCREGISTERTABLE_FIRST_DRIVERSTATE_SLOT + i;
  2661.                 else
  2662.                         smc_state->levels[i].ACIndex = 0;
  2663.  
  2664.                 smc_state->levelCount++;
  2665.         }
  2666.  
  2667.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_watermark_threshold,
  2668.                                       cpu_to_be32(threshold / 512));
  2669.  
  2670.         ni_populate_smc_sp(rdev, radeon_state, smc_state);
  2671.  
  2672.         ret = ni_populate_power_containment_values(rdev, radeon_state, smc_state);
  2673.         if (ret)
  2674.                 ni_pi->enable_power_containment = false;
  2675.  
  2676.         ret = ni_populate_sq_ramping_values(rdev, radeon_state, smc_state);
  2677.         if (ret)
  2678.                 ni_pi->enable_sq_ramping = false;
  2679.  
  2680.         return ni_populate_smc_t(rdev, radeon_state, smc_state);
  2681. }
  2682.  
  2683. static int ni_upload_sw_state(struct radeon_device *rdev,
  2684.                               struct radeon_ps *radeon_new_state)
  2685. {
  2686.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2687.         u16 address = pi->state_table_start +
  2688.                 offsetof(NISLANDS_SMC_STATETABLE, driverState);
  2689.         u16 state_size = sizeof(NISLANDS_SMC_SWSTATE) +
  2690.                 ((NISLANDS_MAX_SMC_PERFORMANCE_LEVELS_PER_SWSTATE - 1) * sizeof(NISLANDS_SMC_HW_PERFORMANCE_LEVEL));
  2691.         int ret;
  2692.         NISLANDS_SMC_SWSTATE *smc_state = kzalloc(state_size, GFP_KERNEL);
  2693.  
  2694.         if (smc_state == NULL)
  2695.                 return -ENOMEM;
  2696.  
  2697.         ret = ni_convert_power_state_to_smc(rdev, radeon_new_state, smc_state);
  2698.         if (ret)
  2699.                 goto done;
  2700.  
  2701.         ret = rv770_copy_bytes_to_smc(rdev, address, (u8 *)smc_state, state_size, pi->sram_end);
  2702.  
  2703. done:
  2704.         kfree(smc_state);
  2705.  
  2706.         return ret;
  2707. }
  2708.  
  2709. static int ni_set_mc_special_registers(struct radeon_device *rdev,
  2710.                                        struct ni_mc_reg_table *table)
  2711. {
  2712.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2713.         u8 i, j, k;
  2714.         u32 temp_reg;
  2715.  
  2716.         for (i = 0, j = table->last; i < table->last; i++) {
  2717.                 switch (table->mc_reg_address[i].s1) {
  2718.                 case MC_SEQ_MISC1 >> 2:
  2719.                         if (j >= SMC_NISLANDS_MC_REGISTER_ARRAY_SIZE)
  2720.                                 return -EINVAL;
  2721.                         temp_reg = RREG32(MC_PMG_CMD_EMRS);
  2722.                         table->mc_reg_address[j].s1 = MC_PMG_CMD_EMRS >> 2;
  2723.                         table->mc_reg_address[j].s0 = MC_SEQ_PMG_CMD_EMRS_LP >> 2;
  2724.                         for (k = 0; k < table->num_entries; k++)
  2725.                                 table->mc_reg_table_entry[k].mc_data[j] =
  2726.                                         ((temp_reg & 0xffff0000)) |
  2727.                                         ((table->mc_reg_table_entry[k].mc_data[i] & 0xffff0000) >> 16);
  2728.                         j++;
  2729.                         if (j >= SMC_NISLANDS_MC_REGISTER_ARRAY_SIZE)
  2730.                                 return -EINVAL;
  2731.  
  2732.                         temp_reg = RREG32(MC_PMG_CMD_MRS);
  2733.                         table->mc_reg_address[j].s1 = MC_PMG_CMD_MRS >> 2;
  2734.                         table->mc_reg_address[j].s0 = MC_SEQ_PMG_CMD_MRS_LP >> 2;
  2735.                         for(k = 0; k < table->num_entries; k++) {
  2736.                                 table->mc_reg_table_entry[k].mc_data[j] =
  2737.                                         (temp_reg & 0xffff0000) |
  2738.                                         (table->mc_reg_table_entry[k].mc_data[i] & 0x0000ffff);
  2739.                                 if (!pi->mem_gddr5)
  2740.                                         table->mc_reg_table_entry[k].mc_data[j] |= 0x100;
  2741.                         }
  2742.                         j++;
  2743.                         if (j > SMC_NISLANDS_MC_REGISTER_ARRAY_SIZE)
  2744.                                 return -EINVAL;
  2745.                         break;
  2746.                 case MC_SEQ_RESERVE_M >> 2:
  2747.                         temp_reg = RREG32(MC_PMG_CMD_MRS1);
  2748.                         table->mc_reg_address[j].s1 = MC_PMG_CMD_MRS1 >> 2;
  2749.                         table->mc_reg_address[j].s0 = MC_SEQ_PMG_CMD_MRS1_LP >> 2;
  2750.                         for (k = 0; k < table->num_entries; k++)
  2751.                                 table->mc_reg_table_entry[k].mc_data[j] =
  2752.                                         (temp_reg & 0xffff0000) |
  2753.                                         (table->mc_reg_table_entry[k].mc_data[i] & 0x0000ffff);
  2754.                         j++;
  2755.                         if (j > SMC_NISLANDS_MC_REGISTER_ARRAY_SIZE)
  2756.                                 return -EINVAL;
  2757.                         break;
  2758.                 default:
  2759.                         break;
  2760.                 }
  2761.         }
  2762.  
  2763.         table->last = j;
  2764.  
  2765.         return 0;
  2766. }
  2767.  
  2768. static bool ni_check_s0_mc_reg_index(u16 in_reg, u16 *out_reg)
  2769. {
  2770.         bool result = true;
  2771.  
  2772.         switch (in_reg) {
  2773.         case  MC_SEQ_RAS_TIMING >> 2:
  2774.                 *out_reg = MC_SEQ_RAS_TIMING_LP >> 2;
  2775.                 break;
  2776.         case MC_SEQ_CAS_TIMING >> 2:
  2777.                 *out_reg = MC_SEQ_CAS_TIMING_LP >> 2;
  2778.                 break;
  2779.         case MC_SEQ_MISC_TIMING >> 2:
  2780.                 *out_reg = MC_SEQ_MISC_TIMING_LP >> 2;
  2781.                 break;
  2782.         case MC_SEQ_MISC_TIMING2 >> 2:
  2783.                 *out_reg = MC_SEQ_MISC_TIMING2_LP >> 2;
  2784.                 break;
  2785.         case MC_SEQ_RD_CTL_D0 >> 2:
  2786.                 *out_reg = MC_SEQ_RD_CTL_D0_LP >> 2;
  2787.                 break;
  2788.         case MC_SEQ_RD_CTL_D1 >> 2:
  2789.                 *out_reg = MC_SEQ_RD_CTL_D1_LP >> 2;
  2790.                 break;
  2791.         case MC_SEQ_WR_CTL_D0 >> 2:
  2792.                 *out_reg = MC_SEQ_WR_CTL_D0_LP >> 2;
  2793.                 break;
  2794.         case MC_SEQ_WR_CTL_D1 >> 2:
  2795.                 *out_reg = MC_SEQ_WR_CTL_D1_LP >> 2;
  2796.                 break;
  2797.         case MC_PMG_CMD_EMRS >> 2:
  2798.                 *out_reg = MC_SEQ_PMG_CMD_EMRS_LP >> 2;
  2799.                 break;
  2800.         case MC_PMG_CMD_MRS >> 2:
  2801.                 *out_reg = MC_SEQ_PMG_CMD_MRS_LP >> 2;
  2802.                 break;
  2803.         case MC_PMG_CMD_MRS1 >> 2:
  2804.                 *out_reg = MC_SEQ_PMG_CMD_MRS1_LP >> 2;
  2805.                 break;
  2806.         case MC_SEQ_PMG_TIMING >> 2:
  2807.                 *out_reg = MC_SEQ_PMG_TIMING_LP >> 2;
  2808.                 break;
  2809.         case MC_PMG_CMD_MRS2 >> 2:
  2810.                 *out_reg = MC_SEQ_PMG_CMD_MRS2_LP >> 2;
  2811.                 break;
  2812.         default:
  2813.                 result = false;
  2814.                 break;
  2815.         }
  2816.  
  2817.         return result;
  2818. }
  2819.  
  2820. static void ni_set_valid_flag(struct ni_mc_reg_table *table)
  2821. {
  2822.         u8 i, j;
  2823.  
  2824.         for (i = 0; i < table->last; i++) {
  2825.                 for (j = 1; j < table->num_entries; j++) {
  2826.                         if (table->mc_reg_table_entry[j-1].mc_data[i] != table->mc_reg_table_entry[j].mc_data[i]) {
  2827.                                 table->valid_flag |= 1 << i;
  2828.                                 break;
  2829.                         }
  2830.                 }
  2831.         }
  2832. }
  2833.  
  2834. static void ni_set_s0_mc_reg_index(struct ni_mc_reg_table *table)
  2835. {
  2836.         u32 i;
  2837.         u16 address;
  2838.  
  2839.         for (i = 0; i < table->last; i++)
  2840.                 table->mc_reg_address[i].s0 =
  2841.                         ni_check_s0_mc_reg_index(table->mc_reg_address[i].s1, &address) ?
  2842.                         address : table->mc_reg_address[i].s1;
  2843. }
  2844.  
  2845. static int ni_copy_vbios_mc_reg_table(struct atom_mc_reg_table *table,
  2846.                                       struct ni_mc_reg_table *ni_table)
  2847. {
  2848.         u8 i, j;
  2849.  
  2850.         if (table->last > SMC_NISLANDS_MC_REGISTER_ARRAY_SIZE)
  2851.                 return -EINVAL;
  2852.         if (table->num_entries > MAX_AC_TIMING_ENTRIES)
  2853.                 return -EINVAL;
  2854.  
  2855.         for (i = 0; i < table->last; i++)
  2856.                 ni_table->mc_reg_address[i].s1 = table->mc_reg_address[i].s1;
  2857.         ni_table->last = table->last;
  2858.  
  2859.         for (i = 0; i < table->num_entries; i++) {
  2860.                 ni_table->mc_reg_table_entry[i].mclk_max =
  2861.                         table->mc_reg_table_entry[i].mclk_max;
  2862.                 for (j = 0; j < table->last; j++)
  2863.                         ni_table->mc_reg_table_entry[i].mc_data[j] =
  2864.                                 table->mc_reg_table_entry[i].mc_data[j];
  2865.         }
  2866.         ni_table->num_entries = table->num_entries;
  2867.  
  2868.         return 0;
  2869. }
  2870.  
  2871. static int ni_initialize_mc_reg_table(struct radeon_device *rdev)
  2872. {
  2873.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2874.         int ret;
  2875.         struct atom_mc_reg_table *table;
  2876.         struct ni_mc_reg_table *ni_table = &ni_pi->mc_reg_table;
  2877.         u8 module_index = rv770_get_memory_module_index(rdev);
  2878.  
  2879.         table = kzalloc(sizeof(struct atom_mc_reg_table), GFP_KERNEL);
  2880.         if (!table)
  2881.                 return -ENOMEM;
  2882.  
  2883.         WREG32(MC_SEQ_RAS_TIMING_LP, RREG32(MC_SEQ_RAS_TIMING));
  2884.         WREG32(MC_SEQ_CAS_TIMING_LP, RREG32(MC_SEQ_CAS_TIMING));
  2885.         WREG32(MC_SEQ_MISC_TIMING_LP, RREG32(MC_SEQ_MISC_TIMING));
  2886.         WREG32(MC_SEQ_MISC_TIMING2_LP, RREG32(MC_SEQ_MISC_TIMING2));
  2887.         WREG32(MC_SEQ_PMG_CMD_EMRS_LP, RREG32(MC_PMG_CMD_EMRS));
  2888.         WREG32(MC_SEQ_PMG_CMD_MRS_LP, RREG32(MC_PMG_CMD_MRS));
  2889.         WREG32(MC_SEQ_PMG_CMD_MRS1_LP, RREG32(MC_PMG_CMD_MRS1));
  2890.         WREG32(MC_SEQ_WR_CTL_D0_LP, RREG32(MC_SEQ_WR_CTL_D0));
  2891.         WREG32(MC_SEQ_WR_CTL_D1_LP, RREG32(MC_SEQ_WR_CTL_D1));
  2892.         WREG32(MC_SEQ_RD_CTL_D0_LP, RREG32(MC_SEQ_RD_CTL_D0));
  2893.         WREG32(MC_SEQ_RD_CTL_D1_LP, RREG32(MC_SEQ_RD_CTL_D1));
  2894.         WREG32(MC_SEQ_PMG_TIMING_LP, RREG32(MC_SEQ_PMG_TIMING));
  2895.         WREG32(MC_SEQ_PMG_CMD_MRS2_LP, RREG32(MC_PMG_CMD_MRS2));
  2896.  
  2897.         ret = radeon_atom_init_mc_reg_table(rdev, module_index, table);
  2898.  
  2899.         if (ret)
  2900.                 goto init_mc_done;
  2901.  
  2902.         ret = ni_copy_vbios_mc_reg_table(table, ni_table);
  2903.  
  2904.         if (ret)
  2905.                 goto init_mc_done;
  2906.  
  2907.         ni_set_s0_mc_reg_index(ni_table);
  2908.  
  2909.         ret = ni_set_mc_special_registers(rdev, ni_table);
  2910.  
  2911.         if (ret)
  2912.                 goto init_mc_done;
  2913.  
  2914.         ni_set_valid_flag(ni_table);
  2915.  
  2916. init_mc_done:
  2917.         kfree(table);
  2918.  
  2919.         return ret;
  2920. }
  2921.  
  2922. static void ni_populate_mc_reg_addresses(struct radeon_device *rdev,
  2923.                                          SMC_NIslands_MCRegisters *mc_reg_table)
  2924. {
  2925.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2926.         u32 i, j;
  2927.  
  2928.         for (i = 0, j = 0; j < ni_pi->mc_reg_table.last; j++) {
  2929.                 if (ni_pi->mc_reg_table.valid_flag & (1 << j)) {
  2930.                         if (i >= SMC_NISLANDS_MC_REGISTER_ARRAY_SIZE)
  2931.                                 break;
  2932.                         mc_reg_table->address[i].s0 =
  2933.                                 cpu_to_be16(ni_pi->mc_reg_table.mc_reg_address[j].s0);
  2934.                         mc_reg_table->address[i].s1 =
  2935.                                 cpu_to_be16(ni_pi->mc_reg_table.mc_reg_address[j].s1);
  2936.                         i++;
  2937.                 }
  2938.         }
  2939.         mc_reg_table->last = (u8)i;
  2940. }
  2941.  
  2942.  
  2943. static void ni_convert_mc_registers(struct ni_mc_reg_entry *entry,
  2944.                                     SMC_NIslands_MCRegisterSet *data,
  2945.                                     u32 num_entries, u32 valid_flag)
  2946. {
  2947.         u32 i, j;
  2948.  
  2949.         for (i = 0, j = 0; j < num_entries; j++) {
  2950.                 if (valid_flag & (1 << j)) {
  2951.                         data->value[i] = cpu_to_be32(entry->mc_data[j]);
  2952.                         i++;
  2953.                 }
  2954.         }
  2955. }
  2956.  
  2957. static void ni_convert_mc_reg_table_entry_to_smc(struct radeon_device *rdev,
  2958.                                                  struct rv7xx_pl *pl,
  2959.                                                  SMC_NIslands_MCRegisterSet *mc_reg_table_data)
  2960. {
  2961.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2962.         u32 i = 0;
  2963.  
  2964.         for (i = 0; i < ni_pi->mc_reg_table.num_entries; i++) {
  2965.                 if (pl->mclk <= ni_pi->mc_reg_table.mc_reg_table_entry[i].mclk_max)
  2966.                         break;
  2967.         }
  2968.  
  2969.         if ((i == ni_pi->mc_reg_table.num_entries) && (i > 0))
  2970.                 --i;
  2971.  
  2972.         ni_convert_mc_registers(&ni_pi->mc_reg_table.mc_reg_table_entry[i],
  2973.                                 mc_reg_table_data,
  2974.                                 ni_pi->mc_reg_table.last,
  2975.                                 ni_pi->mc_reg_table.valid_flag);
  2976. }
  2977.  
  2978. static void ni_convert_mc_reg_table_to_smc(struct radeon_device *rdev,
  2979.                                            struct radeon_ps *radeon_state,
  2980.                                            SMC_NIslands_MCRegisters *mc_reg_table)
  2981. {
  2982.         struct ni_ps *state = ni_get_ps(radeon_state);
  2983.         int i;
  2984.  
  2985.         for (i = 0; i < state->performance_level_count; i++) {
  2986.                 ni_convert_mc_reg_table_entry_to_smc(rdev,
  2987.                                                      &state->performance_levels[i],
  2988.                                                      &mc_reg_table->data[NISLANDS_MCREGISTERTABLE_FIRST_DRIVERSTATE_SLOT + i]);
  2989.         }
  2990. }
  2991.  
  2992. static int ni_populate_mc_reg_table(struct radeon_device *rdev,
  2993.                                     struct radeon_ps *radeon_boot_state)
  2994. {
  2995.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  2996.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  2997.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  2998.         struct ni_ps *boot_state = ni_get_ps(radeon_boot_state);
  2999.         SMC_NIslands_MCRegisters *mc_reg_table = &ni_pi->smc_mc_reg_table;
  3000.  
  3001.         memset(mc_reg_table, 0, sizeof(SMC_NIslands_MCRegisters));
  3002.  
  3003.         rv770_write_smc_soft_register(rdev, NI_SMC_SOFT_REGISTER_seq_index, 1);
  3004.  
  3005.         ni_populate_mc_reg_addresses(rdev, mc_reg_table);
  3006.  
  3007.         ni_convert_mc_reg_table_entry_to_smc(rdev, &boot_state->performance_levels[0],
  3008.                                              &mc_reg_table->data[0]);
  3009.  
  3010.         ni_convert_mc_registers(&ni_pi->mc_reg_table.mc_reg_table_entry[0],
  3011.                                 &mc_reg_table->data[1],
  3012.                                 ni_pi->mc_reg_table.last,
  3013.                                 ni_pi->mc_reg_table.valid_flag);
  3014.  
  3015.         ni_convert_mc_reg_table_to_smc(rdev, radeon_boot_state, mc_reg_table);
  3016.  
  3017.         return rv770_copy_bytes_to_smc(rdev, eg_pi->mc_reg_table_start,
  3018.                                        (u8 *)mc_reg_table,
  3019.                                        sizeof(SMC_NIslands_MCRegisters),
  3020.                                        pi->sram_end);
  3021. }
  3022.  
  3023. static int ni_upload_mc_reg_table(struct radeon_device *rdev,
  3024.                                   struct radeon_ps *radeon_new_state)
  3025. {
  3026.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  3027.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3028.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  3029.         struct ni_ps *ni_new_state = ni_get_ps(radeon_new_state);
  3030.         SMC_NIslands_MCRegisters *mc_reg_table = &ni_pi->smc_mc_reg_table;
  3031.         u16 address;
  3032.  
  3033.         memset(mc_reg_table, 0, sizeof(SMC_NIslands_MCRegisters));
  3034.  
  3035.         ni_convert_mc_reg_table_to_smc(rdev, radeon_new_state, mc_reg_table);
  3036.  
  3037.         address = eg_pi->mc_reg_table_start +
  3038.                 (u16)offsetof(SMC_NIslands_MCRegisters, data[NISLANDS_MCREGISTERTABLE_FIRST_DRIVERSTATE_SLOT]);
  3039.  
  3040.         return rv770_copy_bytes_to_smc(rdev, address,
  3041.                                        (u8 *)&mc_reg_table->data[NISLANDS_MCREGISTERTABLE_FIRST_DRIVERSTATE_SLOT],
  3042.                                        sizeof(SMC_NIslands_MCRegisterSet) * ni_new_state->performance_level_count,
  3043.                                        pi->sram_end);
  3044. }
  3045.  
  3046. static int ni_init_driver_calculated_leakage_table(struct radeon_device *rdev,
  3047.                                                    PP_NIslands_CACTABLES *cac_tables)
  3048. {
  3049.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  3050.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3051.         u32 leakage = 0;
  3052.         unsigned int i, j, table_size;
  3053.         s32 t;
  3054.         u32 smc_leakage, max_leakage = 0;
  3055.         u32 scaling_factor;
  3056.  
  3057.         table_size = eg_pi->vddc_voltage_table.count;
  3058.  
  3059.         if (SMC_NISLANDS_LKGE_LUT_NUM_OF_VOLT_ENTRIES < table_size)
  3060.                 table_size = SMC_NISLANDS_LKGE_LUT_NUM_OF_VOLT_ENTRIES;
  3061.  
  3062.         scaling_factor = ni_get_smc_power_scaling_factor(rdev);
  3063.  
  3064.         for (i = 0; i < SMC_NISLANDS_LKGE_LUT_NUM_OF_TEMP_ENTRIES; i++) {
  3065.                 for (j = 0; j < table_size; j++) {
  3066.                         t = (1000 * ((i + 1) * 8));
  3067.  
  3068.                         if (t < ni_pi->cac_data.leakage_minimum_temperature)
  3069.                                 t = ni_pi->cac_data.leakage_minimum_temperature;
  3070.  
  3071.                         ni_calculate_leakage_for_v_and_t(rdev,
  3072.                                                          &ni_pi->cac_data.leakage_coefficients,
  3073.                                                          eg_pi->vddc_voltage_table.entries[j].value,
  3074.                                                          t,
  3075.                                                          ni_pi->cac_data.i_leakage,
  3076.                                                          &leakage);
  3077.  
  3078.                         smc_leakage = ni_scale_power_for_smc(leakage, scaling_factor) / 1000;
  3079.                         if (smc_leakage > max_leakage)
  3080.                                 max_leakage = smc_leakage;
  3081.  
  3082.                         cac_tables->cac_lkge_lut[i][j] = cpu_to_be32(smc_leakage);
  3083.                 }
  3084.         }
  3085.  
  3086.         for (j = table_size; j < SMC_NISLANDS_LKGE_LUT_NUM_OF_VOLT_ENTRIES; j++) {
  3087.                 for (i = 0; i < SMC_NISLANDS_LKGE_LUT_NUM_OF_TEMP_ENTRIES; i++)
  3088.                         cac_tables->cac_lkge_lut[i][j] = cpu_to_be32(max_leakage);
  3089.         }
  3090.         return 0;
  3091. }
  3092.  
  3093. static int ni_init_simplified_leakage_table(struct radeon_device *rdev,
  3094.                                             PP_NIslands_CACTABLES *cac_tables)
  3095. {
  3096.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3097.         struct radeon_cac_leakage_table *leakage_table =
  3098.                 &rdev->pm.dpm.dyn_state.cac_leakage_table;
  3099.         u32 i, j, table_size;
  3100.         u32 smc_leakage, max_leakage = 0;
  3101.         u32 scaling_factor;
  3102.  
  3103.         if (!leakage_table)
  3104.                 return -EINVAL;
  3105.  
  3106.         table_size = leakage_table->count;
  3107.  
  3108.         if (eg_pi->vddc_voltage_table.count != table_size)
  3109.                 table_size = (eg_pi->vddc_voltage_table.count < leakage_table->count) ?
  3110.                         eg_pi->vddc_voltage_table.count : leakage_table->count;
  3111.  
  3112.         if (SMC_NISLANDS_LKGE_LUT_NUM_OF_VOLT_ENTRIES < table_size)
  3113.                 table_size = SMC_NISLANDS_LKGE_LUT_NUM_OF_VOLT_ENTRIES;
  3114.  
  3115.         if (table_size == 0)
  3116.                 return -EINVAL;
  3117.  
  3118.         scaling_factor = ni_get_smc_power_scaling_factor(rdev);
  3119.  
  3120.         for (j = 0; j < table_size; j++) {
  3121.                 smc_leakage = leakage_table->entries[j].leakage;
  3122.  
  3123.                 if (smc_leakage > max_leakage)
  3124.                         max_leakage = smc_leakage;
  3125.  
  3126.                 for (i = 0; i < SMC_NISLANDS_LKGE_LUT_NUM_OF_TEMP_ENTRIES; i++)
  3127.                         cac_tables->cac_lkge_lut[i][j] =
  3128.                                 cpu_to_be32(ni_scale_power_for_smc(smc_leakage, scaling_factor));
  3129.         }
  3130.  
  3131.         for (j = table_size; j < SMC_NISLANDS_LKGE_LUT_NUM_OF_VOLT_ENTRIES; j++) {
  3132.                 for (i = 0; i < SMC_NISLANDS_LKGE_LUT_NUM_OF_TEMP_ENTRIES; i++)
  3133.                         cac_tables->cac_lkge_lut[i][j] =
  3134.                                 cpu_to_be32(ni_scale_power_for_smc(max_leakage, scaling_factor));
  3135.         }
  3136.         return 0;
  3137. }
  3138.  
  3139. static int ni_initialize_smc_cac_tables(struct radeon_device *rdev)
  3140. {
  3141.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  3142.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  3143.         PP_NIslands_CACTABLES *cac_tables = NULL;
  3144.         int i, ret;
  3145.         u32 reg;
  3146.  
  3147.         if (ni_pi->enable_cac == false)
  3148.                 return 0;
  3149.  
  3150.         cac_tables = kzalloc(sizeof(PP_NIslands_CACTABLES), GFP_KERNEL);
  3151.         if (!cac_tables)
  3152.                 return -ENOMEM;
  3153.  
  3154.         reg = RREG32(CG_CAC_CTRL) & ~(TID_CNT_MASK | TID_UNIT_MASK);
  3155.         reg |= (TID_CNT(ni_pi->cac_weights->tid_cnt) |
  3156.                 TID_UNIT(ni_pi->cac_weights->tid_unit));
  3157.         WREG32(CG_CAC_CTRL, reg);
  3158.  
  3159.         for (i = 0; i < NISLANDS_DCCAC_MAX_LEVELS; i++)
  3160.                 ni_pi->dc_cac_table[i] = ni_pi->cac_weights->dc_cac[i];
  3161.  
  3162.         for (i = 0; i < SMC_NISLANDS_BIF_LUT_NUM_OF_ENTRIES; i++)
  3163.                 cac_tables->cac_bif_lut[i] = ni_pi->cac_weights->pcie_cac[i];
  3164.  
  3165.         ni_pi->cac_data.i_leakage = rdev->pm.dpm.cac_leakage;
  3166.         ni_pi->cac_data.pwr_const = 0;
  3167.         ni_pi->cac_data.dc_cac_value = ni_pi->dc_cac_table[NISLANDS_DCCAC_LEVEL_0];
  3168.         ni_pi->cac_data.bif_cac_value = 0;
  3169.         ni_pi->cac_data.mc_wr_weight = ni_pi->cac_weights->mc_write_weight;
  3170.         ni_pi->cac_data.mc_rd_weight = ni_pi->cac_weights->mc_read_weight;
  3171.         ni_pi->cac_data.allow_ovrflw = 0;
  3172.         ni_pi->cac_data.l2num_win_tdp = ni_pi->lta_window_size;
  3173.         ni_pi->cac_data.num_win_tdp = 0;
  3174.         ni_pi->cac_data.lts_truncate_n = ni_pi->lts_truncate;
  3175.  
  3176.         if (ni_pi->driver_calculate_cac_leakage)
  3177.                 ret = ni_init_driver_calculated_leakage_table(rdev, cac_tables);
  3178.         else
  3179.                 ret = ni_init_simplified_leakage_table(rdev, cac_tables);
  3180.  
  3181.         if (ret)
  3182.                 goto done_free;
  3183.  
  3184.         cac_tables->pwr_const      = cpu_to_be32(ni_pi->cac_data.pwr_const);
  3185.         cac_tables->dc_cacValue    = cpu_to_be32(ni_pi->cac_data.dc_cac_value);
  3186.         cac_tables->bif_cacValue   = cpu_to_be32(ni_pi->cac_data.bif_cac_value);
  3187.         cac_tables->AllowOvrflw    = ni_pi->cac_data.allow_ovrflw;
  3188.         cac_tables->MCWrWeight     = ni_pi->cac_data.mc_wr_weight;
  3189.         cac_tables->MCRdWeight     = ni_pi->cac_data.mc_rd_weight;
  3190.         cac_tables->numWin_TDP     = ni_pi->cac_data.num_win_tdp;
  3191.         cac_tables->l2numWin_TDP   = ni_pi->cac_data.l2num_win_tdp;
  3192.         cac_tables->lts_truncate_n = ni_pi->cac_data.lts_truncate_n;
  3193.  
  3194.         ret = rv770_copy_bytes_to_smc(rdev, ni_pi->cac_table_start, (u8 *)cac_tables,
  3195.                                       sizeof(PP_NIslands_CACTABLES), pi->sram_end);
  3196.  
  3197. done_free:
  3198.         if (ret) {
  3199.                 ni_pi->enable_cac = false;
  3200.                 ni_pi->enable_power_containment = false;
  3201.         }
  3202.  
  3203.         kfree(cac_tables);
  3204.  
  3205.         return 0;
  3206. }
  3207.  
  3208. static int ni_initialize_hardware_cac_manager(struct radeon_device *rdev)
  3209. {
  3210.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  3211.         u32 reg;
  3212.  
  3213.         if (!ni_pi->enable_cac ||
  3214.             !ni_pi->cac_configuration_required)
  3215.                 return 0;
  3216.  
  3217.         if (ni_pi->cac_weights == NULL)
  3218.                 return -EINVAL;
  3219.  
  3220.         reg = RREG32_CG(CG_CAC_REGION_1_WEIGHT_0) & ~(WEIGHT_TCP_SIG0_MASK |
  3221.                                                       WEIGHT_TCP_SIG1_MASK |
  3222.                                                       WEIGHT_TA_SIG_MASK);
  3223.         reg |= (WEIGHT_TCP_SIG0(ni_pi->cac_weights->weight_tcp_sig0) |
  3224.                 WEIGHT_TCP_SIG1(ni_pi->cac_weights->weight_tcp_sig1) |
  3225.                 WEIGHT_TA_SIG(ni_pi->cac_weights->weight_ta_sig));
  3226.         WREG32_CG(CG_CAC_REGION_1_WEIGHT_0, reg);
  3227.  
  3228.         reg = RREG32_CG(CG_CAC_REGION_1_WEIGHT_1) & ~(WEIGHT_TCC_EN0_MASK |
  3229.                                                       WEIGHT_TCC_EN1_MASK |
  3230.                                                       WEIGHT_TCC_EN2_MASK);
  3231.         reg |= (WEIGHT_TCC_EN0(ni_pi->cac_weights->weight_tcc_en0) |
  3232.                 WEIGHT_TCC_EN1(ni_pi->cac_weights->weight_tcc_en1) |
  3233.                 WEIGHT_TCC_EN2(ni_pi->cac_weights->weight_tcc_en2));
  3234.         WREG32_CG(CG_CAC_REGION_1_WEIGHT_1, reg);
  3235.  
  3236.         reg = RREG32_CG(CG_CAC_REGION_2_WEIGHT_0) & ~(WEIGHT_CB_EN0_MASK |
  3237.                                                       WEIGHT_CB_EN1_MASK |
  3238.                                                       WEIGHT_CB_EN2_MASK |
  3239.                                                       WEIGHT_CB_EN3_MASK);
  3240.         reg |= (WEIGHT_CB_EN0(ni_pi->cac_weights->weight_cb_en0) |
  3241.                 WEIGHT_CB_EN1(ni_pi->cac_weights->weight_cb_en1) |
  3242.                 WEIGHT_CB_EN2(ni_pi->cac_weights->weight_cb_en2) |
  3243.                 WEIGHT_CB_EN3(ni_pi->cac_weights->weight_cb_en3));
  3244.         WREG32_CG(CG_CAC_REGION_2_WEIGHT_0, reg);
  3245.  
  3246.         reg = RREG32_CG(CG_CAC_REGION_2_WEIGHT_1) & ~(WEIGHT_DB_SIG0_MASK |
  3247.                                                       WEIGHT_DB_SIG1_MASK |
  3248.                                                       WEIGHT_DB_SIG2_MASK |
  3249.                                                       WEIGHT_DB_SIG3_MASK);
  3250.         reg |= (WEIGHT_DB_SIG0(ni_pi->cac_weights->weight_db_sig0) |
  3251.                 WEIGHT_DB_SIG1(ni_pi->cac_weights->weight_db_sig1) |
  3252.                 WEIGHT_DB_SIG2(ni_pi->cac_weights->weight_db_sig2) |
  3253.                 WEIGHT_DB_SIG3(ni_pi->cac_weights->weight_db_sig3));
  3254.         WREG32_CG(CG_CAC_REGION_2_WEIGHT_1, reg);
  3255.  
  3256.         reg = RREG32_CG(CG_CAC_REGION_2_WEIGHT_2) & ~(WEIGHT_SXM_SIG0_MASK |
  3257.                                                       WEIGHT_SXM_SIG1_MASK |
  3258.                                                       WEIGHT_SXM_SIG2_MASK |
  3259.                                                       WEIGHT_SXS_SIG0_MASK |
  3260.                                                       WEIGHT_SXS_SIG1_MASK);
  3261.         reg |= (WEIGHT_SXM_SIG0(ni_pi->cac_weights->weight_sxm_sig0) |
  3262.                 WEIGHT_SXM_SIG1(ni_pi->cac_weights->weight_sxm_sig1) |
  3263.                 WEIGHT_SXM_SIG2(ni_pi->cac_weights->weight_sxm_sig2) |
  3264.                 WEIGHT_SXS_SIG0(ni_pi->cac_weights->weight_sxs_sig0) |
  3265.                 WEIGHT_SXS_SIG1(ni_pi->cac_weights->weight_sxs_sig1));
  3266.         WREG32_CG(CG_CAC_REGION_2_WEIGHT_2, reg);
  3267.  
  3268.         reg = RREG32_CG(CG_CAC_REGION_3_WEIGHT_0) & ~(WEIGHT_XBR_0_MASK |
  3269.                                                       WEIGHT_XBR_1_MASK |
  3270.                                                       WEIGHT_XBR_2_MASK |
  3271.                                                       WEIGHT_SPI_SIG0_MASK);
  3272.         reg |= (WEIGHT_XBR_0(ni_pi->cac_weights->weight_xbr_0) |
  3273.                 WEIGHT_XBR_1(ni_pi->cac_weights->weight_xbr_1) |
  3274.                 WEIGHT_XBR_2(ni_pi->cac_weights->weight_xbr_2) |
  3275.                 WEIGHT_SPI_SIG0(ni_pi->cac_weights->weight_spi_sig0));
  3276.         WREG32_CG(CG_CAC_REGION_3_WEIGHT_0, reg);
  3277.  
  3278.         reg = RREG32_CG(CG_CAC_REGION_3_WEIGHT_1) & ~(WEIGHT_SPI_SIG1_MASK |
  3279.                                                       WEIGHT_SPI_SIG2_MASK |
  3280.                                                       WEIGHT_SPI_SIG3_MASK |
  3281.                                                       WEIGHT_SPI_SIG4_MASK |
  3282.                                                       WEIGHT_SPI_SIG5_MASK);
  3283.         reg |= (WEIGHT_SPI_SIG1(ni_pi->cac_weights->weight_spi_sig1) |
  3284.                 WEIGHT_SPI_SIG2(ni_pi->cac_weights->weight_spi_sig2) |
  3285.                 WEIGHT_SPI_SIG3(ni_pi->cac_weights->weight_spi_sig3) |
  3286.                 WEIGHT_SPI_SIG4(ni_pi->cac_weights->weight_spi_sig4) |
  3287.                 WEIGHT_SPI_SIG5(ni_pi->cac_weights->weight_spi_sig5));
  3288.         WREG32_CG(CG_CAC_REGION_3_WEIGHT_1, reg);
  3289.  
  3290.         reg = RREG32_CG(CG_CAC_REGION_4_WEIGHT_0) & ~(WEIGHT_LDS_SIG0_MASK |
  3291.                                                       WEIGHT_LDS_SIG1_MASK |
  3292.                                                       WEIGHT_SC_MASK);
  3293.         reg |= (WEIGHT_LDS_SIG0(ni_pi->cac_weights->weight_lds_sig0) |
  3294.                 WEIGHT_LDS_SIG1(ni_pi->cac_weights->weight_lds_sig1) |
  3295.                 WEIGHT_SC(ni_pi->cac_weights->weight_sc));
  3296.         WREG32_CG(CG_CAC_REGION_4_WEIGHT_0, reg);
  3297.  
  3298.         reg = RREG32_CG(CG_CAC_REGION_4_WEIGHT_1) & ~(WEIGHT_BIF_MASK |
  3299.                                                       WEIGHT_CP_MASK |
  3300.                                                       WEIGHT_PA_SIG0_MASK |
  3301.                                                       WEIGHT_PA_SIG1_MASK |
  3302.                                                       WEIGHT_VGT_SIG0_MASK);
  3303.         reg |= (WEIGHT_BIF(ni_pi->cac_weights->weight_bif) |
  3304.                 WEIGHT_CP(ni_pi->cac_weights->weight_cp) |
  3305.                 WEIGHT_PA_SIG0(ni_pi->cac_weights->weight_pa_sig0) |
  3306.                 WEIGHT_PA_SIG1(ni_pi->cac_weights->weight_pa_sig1) |
  3307.                 WEIGHT_VGT_SIG0(ni_pi->cac_weights->weight_vgt_sig0));
  3308.         WREG32_CG(CG_CAC_REGION_4_WEIGHT_1, reg);
  3309.  
  3310.         reg = RREG32_CG(CG_CAC_REGION_4_WEIGHT_2) & ~(WEIGHT_VGT_SIG1_MASK |
  3311.                                                       WEIGHT_VGT_SIG2_MASK |
  3312.                                                       WEIGHT_DC_SIG0_MASK |
  3313.                                                       WEIGHT_DC_SIG1_MASK |
  3314.                                                       WEIGHT_DC_SIG2_MASK);
  3315.         reg |= (WEIGHT_VGT_SIG1(ni_pi->cac_weights->weight_vgt_sig1) |
  3316.                 WEIGHT_VGT_SIG2(ni_pi->cac_weights->weight_vgt_sig2) |
  3317.                 WEIGHT_DC_SIG0(ni_pi->cac_weights->weight_dc_sig0) |
  3318.                 WEIGHT_DC_SIG1(ni_pi->cac_weights->weight_dc_sig1) |
  3319.                 WEIGHT_DC_SIG2(ni_pi->cac_weights->weight_dc_sig2));
  3320.         WREG32_CG(CG_CAC_REGION_4_WEIGHT_2, reg);
  3321.  
  3322.         reg = RREG32_CG(CG_CAC_REGION_4_WEIGHT_3) & ~(WEIGHT_DC_SIG3_MASK |
  3323.                                                       WEIGHT_UVD_SIG0_MASK |
  3324.                                                       WEIGHT_UVD_SIG1_MASK |
  3325.                                                       WEIGHT_SPARE0_MASK |
  3326.                                                       WEIGHT_SPARE1_MASK);
  3327.         reg |= (WEIGHT_DC_SIG3(ni_pi->cac_weights->weight_dc_sig3) |
  3328.                 WEIGHT_UVD_SIG0(ni_pi->cac_weights->weight_uvd_sig0) |
  3329.                 WEIGHT_UVD_SIG1(ni_pi->cac_weights->weight_uvd_sig1) |
  3330.                 WEIGHT_SPARE0(ni_pi->cac_weights->weight_spare0) |
  3331.                 WEIGHT_SPARE1(ni_pi->cac_weights->weight_spare1));
  3332.         WREG32_CG(CG_CAC_REGION_4_WEIGHT_3, reg);
  3333.  
  3334.         reg = RREG32_CG(CG_CAC_REGION_5_WEIGHT_0) & ~(WEIGHT_SQ_VSP_MASK |
  3335.                                                       WEIGHT_SQ_VSP0_MASK);
  3336.         reg |= (WEIGHT_SQ_VSP(ni_pi->cac_weights->weight_sq_vsp) |
  3337.                 WEIGHT_SQ_VSP0(ni_pi->cac_weights->weight_sq_vsp0));
  3338.         WREG32_CG(CG_CAC_REGION_5_WEIGHT_0, reg);
  3339.  
  3340.         reg = RREG32_CG(CG_CAC_REGION_5_WEIGHT_1) & ~(WEIGHT_SQ_GPR_MASK);
  3341.         reg |= WEIGHT_SQ_GPR(ni_pi->cac_weights->weight_sq_gpr);
  3342.         WREG32_CG(CG_CAC_REGION_5_WEIGHT_1, reg);
  3343.  
  3344.         reg = RREG32_CG(CG_CAC_REGION_4_OVERRIDE_4) & ~(OVR_MODE_SPARE_0_MASK |
  3345.                                                         OVR_VAL_SPARE_0_MASK |
  3346.                                                         OVR_MODE_SPARE_1_MASK |
  3347.                                                         OVR_VAL_SPARE_1_MASK);
  3348.         reg |= (OVR_MODE_SPARE_0(ni_pi->cac_weights->ovr_mode_spare_0) |
  3349.                 OVR_VAL_SPARE_0(ni_pi->cac_weights->ovr_val_spare_0) |
  3350.                 OVR_MODE_SPARE_1(ni_pi->cac_weights->ovr_mode_spare_1) |
  3351.                 OVR_VAL_SPARE_1(ni_pi->cac_weights->ovr_val_spare_1));
  3352.         WREG32_CG(CG_CAC_REGION_4_OVERRIDE_4, reg);
  3353.  
  3354.         reg = RREG32(SQ_CAC_THRESHOLD) & ~(VSP_MASK |
  3355.                                            VSP0_MASK |
  3356.                                            GPR_MASK);
  3357.         reg |= (VSP(ni_pi->cac_weights->vsp) |
  3358.                 VSP0(ni_pi->cac_weights->vsp0) |
  3359.                 GPR(ni_pi->cac_weights->gpr));
  3360.         WREG32(SQ_CAC_THRESHOLD, reg);
  3361.  
  3362.         reg = (MCDW_WR_ENABLE |
  3363.                MCDX_WR_ENABLE |
  3364.                MCDY_WR_ENABLE |
  3365.                MCDZ_WR_ENABLE |
  3366.                INDEX(0x09D4));
  3367.         WREG32(MC_CG_CONFIG, reg);
  3368.  
  3369.         reg = (READ_WEIGHT(ni_pi->cac_weights->mc_read_weight) |
  3370.                WRITE_WEIGHT(ni_pi->cac_weights->mc_write_weight) |
  3371.                ALLOW_OVERFLOW);
  3372.         WREG32(MC_CG_DATAPORT, reg);
  3373.  
  3374.         return 0;
  3375. }
  3376.  
  3377. static int ni_enable_smc_cac(struct radeon_device *rdev,
  3378.                              struct radeon_ps *radeon_new_state,
  3379.                              bool enable)
  3380. {
  3381.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  3382.         int ret = 0;
  3383.         PPSMC_Result smc_result;
  3384.  
  3385.         if (ni_pi->enable_cac) {
  3386.                 if (enable) {
  3387.                         if (!r600_is_uvd_state(radeon_new_state->class, radeon_new_state->class2)) {
  3388.                                 smc_result = rv770_send_msg_to_smc(rdev, PPSMC_MSG_CollectCAC_PowerCorreln);
  3389.  
  3390.                                 if (ni_pi->support_cac_long_term_average) {
  3391.                                         smc_result = rv770_send_msg_to_smc(rdev, PPSMC_CACLongTermAvgEnable);
  3392.                                         if (PPSMC_Result_OK != smc_result)
  3393.                                                 ni_pi->support_cac_long_term_average = false;
  3394.                                 }
  3395.  
  3396.                                 smc_result = rv770_send_msg_to_smc(rdev, PPSMC_MSG_EnableCac);
  3397.                                 if (PPSMC_Result_OK != smc_result)
  3398.                                         ret = -EINVAL;
  3399.  
  3400.                                 ni_pi->cac_enabled = (PPSMC_Result_OK == smc_result) ? true : false;
  3401.                         }
  3402.                 } else if (ni_pi->cac_enabled) {
  3403.                         smc_result = rv770_send_msg_to_smc(rdev, PPSMC_MSG_DisableCac);
  3404.  
  3405.                         ni_pi->cac_enabled = false;
  3406.  
  3407.                         if (ni_pi->support_cac_long_term_average) {
  3408.                                 smc_result = rv770_send_msg_to_smc(rdev, PPSMC_CACLongTermAvgDisable);
  3409.                                 if (PPSMC_Result_OK != smc_result)
  3410.                                         ni_pi->support_cac_long_term_average = false;
  3411.                         }
  3412.                 }
  3413.         }
  3414.  
  3415.         return ret;
  3416. }
  3417.  
  3418. static int ni_pcie_performance_request(struct radeon_device *rdev,
  3419.                                        u8 perf_req, bool advertise)
  3420. {
  3421. #if defined(CONFIG_ACPI)
  3422.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3423.  
  3424.         if ((perf_req == PCIE_PERF_REQ_PECI_GEN1) ||
  3425.             (perf_req == PCIE_PERF_REQ_PECI_GEN2)) {
  3426.                 if (eg_pi->pcie_performance_request_registered == false)
  3427.                         radeon_acpi_pcie_notify_device_ready(rdev);
  3428.                 eg_pi->pcie_performance_request_registered = true;
  3429.                 return radeon_acpi_pcie_performance_request(rdev, perf_req, advertise);
  3430.         } else if ((perf_req == PCIE_PERF_REQ_REMOVE_REGISTRY) &&
  3431.                    eg_pi->pcie_performance_request_registered) {
  3432.                 eg_pi->pcie_performance_request_registered = false;
  3433.                 return radeon_acpi_pcie_performance_request(rdev, perf_req, advertise);
  3434.         }
  3435. #endif
  3436.         return 0;
  3437. }
  3438.  
  3439. static int ni_advertise_gen2_capability(struct radeon_device *rdev)
  3440. {
  3441.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  3442.         u32 tmp;
  3443.  
  3444.         tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL);
  3445.  
  3446.         if ((tmp & LC_OTHER_SIDE_EVER_SENT_GEN2) &&
  3447.             (tmp & LC_OTHER_SIDE_SUPPORTS_GEN2))
  3448.                 pi->pcie_gen2 = true;
  3449.         else
  3450.                 pi->pcie_gen2 = false;
  3451.  
  3452.         if (!pi->pcie_gen2)
  3453.                 ni_pcie_performance_request(rdev, PCIE_PERF_REQ_PECI_GEN2, true);
  3454.  
  3455.         return 0;
  3456. }
  3457.  
  3458. static void ni_enable_bif_dynamic_pcie_gen2(struct radeon_device *rdev,
  3459.                                             bool enable)
  3460. {
  3461.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  3462.         u32 tmp, bif;
  3463.  
  3464.         tmp = RREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL);
  3465.  
  3466.         if ((tmp & LC_OTHER_SIDE_EVER_SENT_GEN2) &&
  3467.             (tmp & LC_OTHER_SIDE_SUPPORTS_GEN2)) {
  3468.                 if (enable) {
  3469.                         if (!pi->boot_in_gen2) {
  3470.                                 bif = RREG32(CG_BIF_REQ_AND_RSP) & ~CG_CLIENT_REQ_MASK;
  3471.                                 bif |= CG_CLIENT_REQ(0xd);
  3472.                                 WREG32(CG_BIF_REQ_AND_RSP, bif);
  3473.                         }
  3474.                         tmp &= ~LC_HW_VOLTAGE_IF_CONTROL_MASK;
  3475.                         tmp |= LC_HW_VOLTAGE_IF_CONTROL(1);
  3476.                         tmp |= LC_GEN2_EN_STRAP;
  3477.  
  3478.                         tmp |= LC_CLR_FAILED_SPD_CHANGE_CNT;
  3479.                         WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp);
  3480.                         udelay(10);
  3481.                         tmp &= ~LC_CLR_FAILED_SPD_CHANGE_CNT;
  3482.                         WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp);
  3483.                 } else {
  3484.                         if (!pi->boot_in_gen2) {
  3485.                                 bif = RREG32(CG_BIF_REQ_AND_RSP) & ~CG_CLIENT_REQ_MASK;
  3486.                                 bif |= CG_CLIENT_REQ(0xd);
  3487.                                 WREG32(CG_BIF_REQ_AND_RSP, bif);
  3488.  
  3489.                                 tmp &= ~LC_HW_VOLTAGE_IF_CONTROL_MASK;
  3490.                                 tmp &= ~LC_GEN2_EN_STRAP;
  3491.                         }
  3492.                         WREG32_PCIE_PORT(PCIE_LC_SPEED_CNTL, tmp);
  3493.                 }
  3494.         }
  3495. }
  3496.  
  3497. static void ni_enable_dynamic_pcie_gen2(struct radeon_device *rdev,
  3498.                                         bool enable)
  3499. {
  3500.         ni_enable_bif_dynamic_pcie_gen2(rdev, enable);
  3501.  
  3502.         if (enable)
  3503.                 WREG32_P(GENERAL_PWRMGT, ENABLE_GEN2PCIE, ~ENABLE_GEN2PCIE);
  3504.         else
  3505.                 WREG32_P(GENERAL_PWRMGT, 0, ~ENABLE_GEN2PCIE);
  3506. }
  3507.  
  3508. void ni_set_uvd_clock_before_set_eng_clock(struct radeon_device *rdev,
  3509.                                            struct radeon_ps *new_ps,
  3510.                                            struct radeon_ps *old_ps)
  3511. {
  3512.         struct ni_ps *new_state = ni_get_ps(new_ps);
  3513.         struct ni_ps *current_state = ni_get_ps(old_ps);
  3514.  
  3515.         if ((new_ps->vclk == old_ps->vclk) &&
  3516.             (new_ps->dclk == old_ps->dclk))
  3517.                 return;
  3518.  
  3519.         if (new_state->performance_levels[new_state->performance_level_count - 1].sclk >=
  3520.             current_state->performance_levels[current_state->performance_level_count - 1].sclk)
  3521.                 return;
  3522.  
  3523.         radeon_set_uvd_clocks(rdev, new_ps->vclk, new_ps->dclk);
  3524. }
  3525.  
  3526. void ni_set_uvd_clock_after_set_eng_clock(struct radeon_device *rdev,
  3527.                                           struct radeon_ps *new_ps,
  3528.                                           struct radeon_ps *old_ps)
  3529. {
  3530.         struct ni_ps *new_state = ni_get_ps(new_ps);
  3531.         struct ni_ps *current_state = ni_get_ps(old_ps);
  3532.  
  3533.         if ((new_ps->vclk == old_ps->vclk) &&
  3534.             (new_ps->dclk == old_ps->dclk))
  3535.                 return;
  3536.  
  3537.         if (new_state->performance_levels[new_state->performance_level_count - 1].sclk <
  3538.             current_state->performance_levels[current_state->performance_level_count - 1].sclk)
  3539.                 return;
  3540.  
  3541.         radeon_set_uvd_clocks(rdev, new_ps->vclk, new_ps->dclk);
  3542. }
  3543.  
  3544. void ni_dpm_setup_asic(struct radeon_device *rdev)
  3545. {
  3546.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3547.         int r;
  3548.  
  3549.         r = ni_mc_load_microcode(rdev);
  3550.         if (r)
  3551.                 DRM_ERROR("Failed to load MC firmware!\n");
  3552.         ni_read_clock_registers(rdev);
  3553.         btc_read_arb_registers(rdev);
  3554.         rv770_get_memory_type(rdev);
  3555.         if (eg_pi->pcie_performance_request)
  3556.                 ni_advertise_gen2_capability(rdev);
  3557.         rv770_get_pcie_gen2_status(rdev);
  3558.         rv770_enable_acpi_pm(rdev);
  3559. }
  3560.  
  3561. void ni_update_current_ps(struct radeon_device *rdev,
  3562.                           struct radeon_ps *rps)
  3563. {
  3564.         struct ni_ps *new_ps = ni_get_ps(rps);
  3565.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3566.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  3567.  
  3568.         eg_pi->current_rps = *rps;
  3569.         ni_pi->current_ps = *new_ps;
  3570.         eg_pi->current_rps.ps_priv = &ni_pi->current_ps;
  3571. }
  3572.  
  3573. void ni_update_requested_ps(struct radeon_device *rdev,
  3574.                             struct radeon_ps *rps)
  3575. {
  3576.         struct ni_ps *new_ps = ni_get_ps(rps);
  3577.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3578.         struct ni_power_info *ni_pi = ni_get_pi(rdev);
  3579.  
  3580.         eg_pi->requested_rps = *rps;
  3581.         ni_pi->requested_ps = *new_ps;
  3582.         eg_pi->requested_rps.ps_priv = &ni_pi->requested_ps;
  3583. }
  3584.  
  3585. int ni_dpm_enable(struct radeon_device *rdev)
  3586. {
  3587.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  3588.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3589.         struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
  3590.         int ret;
  3591.  
  3592.         if (pi->gfx_clock_gating)
  3593.                 ni_cg_clockgating_default(rdev);
  3594.         if (btc_dpm_enabled(rdev))
  3595.                 return -EINVAL;
  3596.         if (pi->mg_clock_gating)
  3597.                 ni_mg_clockgating_default(rdev);
  3598.         if (eg_pi->ls_clock_gating)
  3599.                 ni_ls_clockgating_default(rdev);
  3600.         if (pi->voltage_control) {
  3601.                 rv770_enable_voltage_control(rdev, true);
  3602.                 ret = cypress_construct_voltage_tables(rdev);
  3603.                 if (ret) {
  3604.                         DRM_ERROR("cypress_construct_voltage_tables failed\n");
  3605.                         return ret;
  3606.                 }
  3607.         }
  3608.         if (eg_pi->dynamic_ac_timing) {
  3609.                 ret = ni_initialize_mc_reg_table(rdev);
  3610.                 if (ret)
  3611.                         eg_pi->dynamic_ac_timing = false;
  3612.         }
  3613.         if (pi->dynamic_ss)
  3614.                 cypress_enable_spread_spectrum(rdev, true);
  3615.         if (pi->thermal_protection)
  3616.                 rv770_enable_thermal_protection(rdev, true);
  3617.         rv770_setup_bsp(rdev);
  3618.         rv770_program_git(rdev);
  3619.         rv770_program_tp(rdev);
  3620.         rv770_program_tpp(rdev);
  3621.         rv770_program_sstp(rdev);
  3622.         cypress_enable_display_gap(rdev);
  3623.         rv770_program_vc(rdev);
  3624.         if (pi->dynamic_pcie_gen2)
  3625.                 ni_enable_dynamic_pcie_gen2(rdev, true);
  3626.         ret = rv770_upload_firmware(rdev);
  3627.         if (ret) {
  3628.                 DRM_ERROR("rv770_upload_firmware failed\n");
  3629.                 return ret;
  3630.         }
  3631.         ret = ni_process_firmware_header(rdev);
  3632.         if (ret) {
  3633.                 DRM_ERROR("ni_process_firmware_header failed\n");
  3634.                 return ret;
  3635.         }
  3636.         ret = ni_initial_switch_from_arb_f0_to_f1(rdev);
  3637.         if (ret) {
  3638.                 DRM_ERROR("ni_initial_switch_from_arb_f0_to_f1 failed\n");
  3639.                 return ret;
  3640.         }
  3641.         ret = ni_init_smc_table(rdev);
  3642.         if (ret) {
  3643.                 DRM_ERROR("ni_init_smc_table failed\n");
  3644.                 return ret;
  3645.         }
  3646.         ret = ni_init_smc_spll_table(rdev);
  3647.         if (ret) {
  3648.                 DRM_ERROR("ni_init_smc_spll_table failed\n");
  3649.                 return ret;
  3650.         }
  3651.         ret = ni_init_arb_table_index(rdev);
  3652.         if (ret) {
  3653.                 DRM_ERROR("ni_init_arb_table_index failed\n");
  3654.                 return ret;
  3655.         }
  3656.         if (eg_pi->dynamic_ac_timing) {
  3657.                 ret = ni_populate_mc_reg_table(rdev, boot_ps);
  3658.                 if (ret) {
  3659.                         DRM_ERROR("ni_populate_mc_reg_table failed\n");
  3660.                         return ret;
  3661.                 }
  3662.         }
  3663.         ret = ni_initialize_smc_cac_tables(rdev);
  3664.         if (ret) {
  3665.                 DRM_ERROR("ni_initialize_smc_cac_tables failed\n");
  3666.                 return ret;
  3667.         }
  3668.         ret = ni_initialize_hardware_cac_manager(rdev);
  3669.         if (ret) {
  3670.                 DRM_ERROR("ni_initialize_hardware_cac_manager failed\n");
  3671.                 return ret;
  3672.         }
  3673.         ret = ni_populate_smc_tdp_limits(rdev, boot_ps);
  3674.         if (ret) {
  3675.                 DRM_ERROR("ni_populate_smc_tdp_limits failed\n");
  3676.                 return ret;
  3677.         }
  3678.         ni_program_response_times(rdev);
  3679.         r7xx_start_smc(rdev);
  3680.         ret = cypress_notify_smc_display_change(rdev, false);
  3681.         if (ret) {
  3682.                 DRM_ERROR("cypress_notify_smc_display_change failed\n");
  3683.                 return ret;
  3684.         }
  3685.         cypress_enable_sclk_control(rdev, true);
  3686.         if (eg_pi->memory_transition)
  3687.                 cypress_enable_mclk_control(rdev, true);
  3688.         cypress_start_dpm(rdev);
  3689.         if (pi->gfx_clock_gating)
  3690.                 ni_gfx_clockgating_enable(rdev, true);
  3691.         if (pi->mg_clock_gating)
  3692.                 ni_mg_clockgating_enable(rdev, true);
  3693.         if (eg_pi->ls_clock_gating)
  3694.                 ni_ls_clockgating_enable(rdev, true);
  3695.  
  3696.         rv770_enable_auto_throttle_source(rdev, RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL, true);
  3697.  
  3698.         ni_update_current_ps(rdev, boot_ps);
  3699.  
  3700.         return 0;
  3701. }
  3702.  
  3703. void ni_dpm_disable(struct radeon_device *rdev)
  3704. {
  3705.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  3706.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3707.         struct radeon_ps *boot_ps = rdev->pm.dpm.boot_ps;
  3708.  
  3709.         if (!btc_dpm_enabled(rdev))
  3710.                 return;
  3711.         rv770_clear_vc(rdev);
  3712.         if (pi->thermal_protection)
  3713.                 rv770_enable_thermal_protection(rdev, false);
  3714.         ni_enable_power_containment(rdev, boot_ps, false);
  3715.         ni_enable_smc_cac(rdev, boot_ps, false);
  3716.         cypress_enable_spread_spectrum(rdev, false);
  3717.         rv770_enable_auto_throttle_source(rdev, RADEON_DPM_AUTO_THROTTLE_SRC_THERMAL, false);
  3718.         if (pi->dynamic_pcie_gen2)
  3719.                 ni_enable_dynamic_pcie_gen2(rdev, false);
  3720.  
  3721.         if (rdev->irq.installed &&
  3722.             r600_is_internal_thermal_sensor(rdev->pm.int_thermal_type)) {
  3723.                 rdev->irq.dpm_thermal = false;
  3724.                 radeon_irq_set(rdev);
  3725.         }
  3726.  
  3727.         if (pi->gfx_clock_gating)
  3728.                 ni_gfx_clockgating_enable(rdev, false);
  3729.         if (pi->mg_clock_gating)
  3730.                 ni_mg_clockgating_enable(rdev, false);
  3731.         if (eg_pi->ls_clock_gating)
  3732.                 ni_ls_clockgating_enable(rdev, false);
  3733.         ni_stop_dpm(rdev);
  3734.         btc_reset_to_default(rdev);
  3735.         ni_stop_smc(rdev);
  3736.         ni_force_switch_to_arb_f0(rdev);
  3737.  
  3738.         ni_update_current_ps(rdev, boot_ps);
  3739. }
  3740.  
  3741. static int ni_power_control_set_level(struct radeon_device *rdev)
  3742. {
  3743.         struct radeon_ps *new_ps = rdev->pm.dpm.requested_ps;
  3744.         int ret;
  3745.  
  3746.         ret = ni_restrict_performance_levels_before_switch(rdev);
  3747.         if (ret)
  3748.                 return ret;
  3749.         ret = rv770_halt_smc(rdev);
  3750.         if (ret)
  3751.                 return ret;
  3752.         ret = ni_populate_smc_tdp_limits(rdev, new_ps);
  3753.         if (ret)
  3754.                 return ret;
  3755.         ret = rv770_resume_smc(rdev);
  3756.         if (ret)
  3757.                 return ret;
  3758.         ret = rv770_set_sw_state(rdev);
  3759.         if (ret)
  3760.                 return ret;
  3761.  
  3762.         return 0;
  3763. }
  3764.  
  3765. int ni_dpm_pre_set_power_state(struct radeon_device *rdev)
  3766. {
  3767.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3768.         struct radeon_ps requested_ps = *rdev->pm.dpm.requested_ps;
  3769.         struct radeon_ps *new_ps = &requested_ps;
  3770.  
  3771.         ni_update_requested_ps(rdev, new_ps);
  3772.  
  3773.         ni_apply_state_adjust_rules(rdev, &eg_pi->requested_rps);
  3774.  
  3775.         return 0;
  3776. }
  3777.  
  3778. int ni_dpm_set_power_state(struct radeon_device *rdev)
  3779. {
  3780.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3781.         struct radeon_ps *new_ps = &eg_pi->requested_rps;
  3782.         struct radeon_ps *old_ps = &eg_pi->current_rps;
  3783.         int ret;
  3784.  
  3785.         ret = ni_restrict_performance_levels_before_switch(rdev);
  3786.         if (ret) {
  3787.                 DRM_ERROR("ni_restrict_performance_levels_before_switch failed\n");
  3788.                 return ret;
  3789.         }
  3790.         ni_set_uvd_clock_before_set_eng_clock(rdev, new_ps, old_ps);
  3791.         ret = ni_enable_power_containment(rdev, new_ps, false);
  3792.         if (ret) {
  3793.                 DRM_ERROR("ni_enable_power_containment failed\n");
  3794.                 return ret;
  3795.         }
  3796.         ret = ni_enable_smc_cac(rdev, new_ps, false);
  3797.         if (ret) {
  3798.                 DRM_ERROR("ni_enable_smc_cac failed\n");
  3799.                 return ret;
  3800.         }
  3801.         ret = rv770_halt_smc(rdev);
  3802.         if (ret) {
  3803.                 DRM_ERROR("rv770_halt_smc failed\n");
  3804.                 return ret;
  3805.         }
  3806.         if (eg_pi->smu_uvd_hs)
  3807.                 btc_notify_uvd_to_smc(rdev, new_ps);
  3808.         ret = ni_upload_sw_state(rdev, new_ps);
  3809.         if (ret) {
  3810.                 DRM_ERROR("ni_upload_sw_state failed\n");
  3811.                 return ret;
  3812.         }
  3813.         if (eg_pi->dynamic_ac_timing) {
  3814.                 ret = ni_upload_mc_reg_table(rdev, new_ps);
  3815.                 if (ret) {
  3816.                         DRM_ERROR("ni_upload_mc_reg_table failed\n");
  3817.                         return ret;
  3818.                 }
  3819.         }
  3820.         ret = ni_program_memory_timing_parameters(rdev, new_ps);
  3821.         if (ret) {
  3822.                 DRM_ERROR("ni_program_memory_timing_parameters failed\n");
  3823.                 return ret;
  3824.         }
  3825.         ret = rv770_resume_smc(rdev);
  3826.         if (ret) {
  3827.                 DRM_ERROR("rv770_resume_smc failed\n");
  3828.                 return ret;
  3829.         }
  3830.         ret = rv770_set_sw_state(rdev);
  3831.         if (ret) {
  3832.                 DRM_ERROR("rv770_set_sw_state failed\n");
  3833.                 return ret;
  3834.         }
  3835.         ni_set_uvd_clock_after_set_eng_clock(rdev, new_ps, old_ps);
  3836.         ret = ni_enable_smc_cac(rdev, new_ps, true);
  3837.         if (ret) {
  3838.                 DRM_ERROR("ni_enable_smc_cac failed\n");
  3839.                 return ret;
  3840.         }
  3841.         ret = ni_enable_power_containment(rdev, new_ps, true);
  3842.         if (ret) {
  3843.                 DRM_ERROR("ni_enable_power_containment failed\n");
  3844.                 return ret;
  3845.         }
  3846.  
  3847.         /* update tdp */
  3848.         ret = ni_power_control_set_level(rdev);
  3849.         if (ret) {
  3850.                 DRM_ERROR("ni_power_control_set_level failed\n");
  3851.                 return ret;
  3852.         }
  3853.  
  3854.         return 0;
  3855. }
  3856.  
  3857. void ni_dpm_post_set_power_state(struct radeon_device *rdev)
  3858. {
  3859.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3860.         struct radeon_ps *new_ps = &eg_pi->requested_rps;
  3861.  
  3862.         ni_update_current_ps(rdev, new_ps);
  3863. }
  3864.  
  3865. #if 0
  3866. void ni_dpm_reset_asic(struct radeon_device *rdev)
  3867. {
  3868.         ni_restrict_performance_levels_before_switch(rdev);
  3869.         rv770_set_boot_state(rdev);
  3870. }
  3871. #endif
  3872.  
  3873. union power_info {
  3874.         struct _ATOM_POWERPLAY_INFO info;
  3875.         struct _ATOM_POWERPLAY_INFO_V2 info_2;
  3876.         struct _ATOM_POWERPLAY_INFO_V3 info_3;
  3877.         struct _ATOM_PPLIB_POWERPLAYTABLE pplib;
  3878.         struct _ATOM_PPLIB_POWERPLAYTABLE2 pplib2;
  3879.         struct _ATOM_PPLIB_POWERPLAYTABLE3 pplib3;
  3880. };
  3881.  
  3882. union pplib_clock_info {
  3883.         struct _ATOM_PPLIB_R600_CLOCK_INFO r600;
  3884.         struct _ATOM_PPLIB_RS780_CLOCK_INFO rs780;
  3885.         struct _ATOM_PPLIB_EVERGREEN_CLOCK_INFO evergreen;
  3886.         struct _ATOM_PPLIB_SUMO_CLOCK_INFO sumo;
  3887. };
  3888.  
  3889. union pplib_power_state {
  3890.         struct _ATOM_PPLIB_STATE v1;
  3891.         struct _ATOM_PPLIB_STATE_V2 v2;
  3892. };
  3893.  
  3894. static void ni_parse_pplib_non_clock_info(struct radeon_device *rdev,
  3895.                                           struct radeon_ps *rps,
  3896.                                           struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info,
  3897.                                           u8 table_rev)
  3898. {
  3899.         rps->caps = le32_to_cpu(non_clock_info->ulCapsAndSettings);
  3900.         rps->class = le16_to_cpu(non_clock_info->usClassification);
  3901.         rps->class2 = le16_to_cpu(non_clock_info->usClassification2);
  3902.  
  3903.         if (ATOM_PPLIB_NONCLOCKINFO_VER1 < table_rev) {
  3904.                 rps->vclk = le32_to_cpu(non_clock_info->ulVCLK);
  3905.                 rps->dclk = le32_to_cpu(non_clock_info->ulDCLK);
  3906.         } else if (r600_is_uvd_state(rps->class, rps->class2)) {
  3907.                 rps->vclk = RV770_DEFAULT_VCLK_FREQ;
  3908.                 rps->dclk = RV770_DEFAULT_DCLK_FREQ;
  3909.         } else {
  3910.                 rps->vclk = 0;
  3911.                 rps->dclk = 0;
  3912.         }
  3913.  
  3914.         if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT)
  3915.                 rdev->pm.dpm.boot_ps = rps;
  3916.         if (rps->class & ATOM_PPLIB_CLASSIFICATION_UVDSTATE)
  3917.                 rdev->pm.dpm.uvd_ps = rps;
  3918. }
  3919.  
  3920. static void ni_parse_pplib_clock_info(struct radeon_device *rdev,
  3921.                                       struct radeon_ps *rps, int index,
  3922.                                       union pplib_clock_info *clock_info)
  3923. {
  3924.         struct rv7xx_power_info *pi = rv770_get_pi(rdev);
  3925.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  3926.         struct ni_ps *ps = ni_get_ps(rps);
  3927.         struct rv7xx_pl *pl = &ps->performance_levels[index];
  3928.  
  3929.         ps->performance_level_count = index + 1;
  3930.  
  3931.         pl->sclk = le16_to_cpu(clock_info->evergreen.usEngineClockLow);
  3932.         pl->sclk |= clock_info->evergreen.ucEngineClockHigh << 16;
  3933.         pl->mclk = le16_to_cpu(clock_info->evergreen.usMemoryClockLow);
  3934.         pl->mclk |= clock_info->evergreen.ucMemoryClockHigh << 16;
  3935.  
  3936.         pl->vddc = le16_to_cpu(clock_info->evergreen.usVDDC);
  3937.         pl->vddci = le16_to_cpu(clock_info->evergreen.usVDDCI);
  3938.         pl->flags = le32_to_cpu(clock_info->evergreen.ulFlags);
  3939.  
  3940.         /* patch up vddc if necessary */
  3941.         if (pl->vddc == 0xff01) {
  3942.                 if (pi->max_vddc)
  3943.                         pl->vddc = pi->max_vddc;
  3944.         }
  3945.  
  3946.         if (rps->class & ATOM_PPLIB_CLASSIFICATION_ACPI) {
  3947.                 pi->acpi_vddc = pl->vddc;
  3948.                 eg_pi->acpi_vddci = pl->vddci;
  3949.                 if (ps->performance_levels[0].flags & ATOM_PPLIB_R600_FLAGS_PCIEGEN2)
  3950.                         pi->acpi_pcie_gen2 = true;
  3951.                 else
  3952.                         pi->acpi_pcie_gen2 = false;
  3953.         }
  3954.  
  3955.         if (rps->class2 & ATOM_PPLIB_CLASSIFICATION2_ULV) {
  3956.                 eg_pi->ulv.supported = true;
  3957.                 eg_pi->ulv.pl = pl;
  3958.         }
  3959.  
  3960.         if (pi->min_vddc_in_table > pl->vddc)
  3961.                 pi->min_vddc_in_table = pl->vddc;
  3962.  
  3963.         if (pi->max_vddc_in_table < pl->vddc)
  3964.                 pi->max_vddc_in_table = pl->vddc;
  3965.  
  3966.         /* patch up boot state */
  3967.         if (rps->class & ATOM_PPLIB_CLASSIFICATION_BOOT) {
  3968.                 u16 vddc, vddci, mvdd;
  3969.                 radeon_atombios_get_default_voltages(rdev, &vddc, &vddci, &mvdd);
  3970.                 pl->mclk = rdev->clock.default_mclk;
  3971.                 pl->sclk = rdev->clock.default_sclk;
  3972.                 pl->vddc = vddc;
  3973.                 pl->vddci = vddci;
  3974.         }
  3975.  
  3976.         if ((rps->class & ATOM_PPLIB_CLASSIFICATION_UI_MASK) ==
  3977.             ATOM_PPLIB_CLASSIFICATION_UI_PERFORMANCE) {
  3978.                 rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.sclk = pl->sclk;
  3979.                 rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.mclk = pl->mclk;
  3980.                 rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddc = pl->vddc;
  3981.                 rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac.vddci = pl->vddci;
  3982.         }
  3983. }
  3984.  
  3985. static int ni_parse_power_table(struct radeon_device *rdev)
  3986. {
  3987.         struct radeon_mode_info *mode_info = &rdev->mode_info;
  3988.         struct _ATOM_PPLIB_NONCLOCK_INFO *non_clock_info;
  3989.         union pplib_power_state *power_state;
  3990.         int i, j;
  3991.         union pplib_clock_info *clock_info;
  3992.         union power_info *power_info;
  3993.         int index = GetIndexIntoMasterTable(DATA, PowerPlayInfo);
  3994.         u16 data_offset;
  3995.         u8 frev, crev;
  3996.         struct ni_ps *ps;
  3997.  
  3998.         if (!atom_parse_data_header(mode_info->atom_context, index, NULL,
  3999.                                    &frev, &crev, &data_offset))
  4000.                 return -EINVAL;
  4001.         power_info = (union power_info *)(mode_info->atom_context->bios + data_offset);
  4002.  
  4003.         rdev->pm.dpm.ps = kzalloc(sizeof(struct radeon_ps) *
  4004.                                   power_info->pplib.ucNumStates, GFP_KERNEL);
  4005.         if (!rdev->pm.dpm.ps)
  4006.                 return -ENOMEM;
  4007.  
  4008.         for (i = 0; i < power_info->pplib.ucNumStates; i++) {
  4009.                 power_state = (union pplib_power_state *)
  4010.                         (mode_info->atom_context->bios + data_offset +
  4011.                          le16_to_cpu(power_info->pplib.usStateArrayOffset) +
  4012.                          i * power_info->pplib.ucStateEntrySize);
  4013.                 non_clock_info = (struct _ATOM_PPLIB_NONCLOCK_INFO *)
  4014.                         (mode_info->atom_context->bios + data_offset +
  4015.                          le16_to_cpu(power_info->pplib.usNonClockInfoArrayOffset) +
  4016.                          (power_state->v1.ucNonClockStateIndex *
  4017.                           power_info->pplib.ucNonClockSize));
  4018.                 if (power_info->pplib.ucStateEntrySize - 1) {
  4019.                         u8 *idx;
  4020.                         ps = kzalloc(sizeof(struct ni_ps), GFP_KERNEL);
  4021.                         if (ps == NULL) {
  4022.                                 kfree(rdev->pm.dpm.ps);
  4023.                                 return -ENOMEM;
  4024.                         }
  4025.                         rdev->pm.dpm.ps[i].ps_priv = ps;
  4026.                         ni_parse_pplib_non_clock_info(rdev, &rdev->pm.dpm.ps[i],
  4027.                                                          non_clock_info,
  4028.                                                          power_info->pplib.ucNonClockSize);
  4029.                         idx = (u8 *)&power_state->v1.ucClockStateIndices[0];
  4030.                         for (j = 0; j < (power_info->pplib.ucStateEntrySize - 1); j++) {
  4031.                                 clock_info = (union pplib_clock_info *)
  4032.                                         (mode_info->atom_context->bios + data_offset +
  4033.                                          le16_to_cpu(power_info->pplib.usClockInfoArrayOffset) +
  4034.                                          (idx[j] * power_info->pplib.ucClockInfoSize));
  4035.                                 ni_parse_pplib_clock_info(rdev,
  4036.                                                           &rdev->pm.dpm.ps[i], j,
  4037.                                                           clock_info);
  4038.                         }
  4039.                 }
  4040.         }
  4041.         rdev->pm.dpm.num_ps = power_info->pplib.ucNumStates;
  4042.         return 0;
  4043. }
  4044.  
  4045. int ni_dpm_init(struct radeon_device *rdev)
  4046. {
  4047.         struct rv7xx_power_info *pi;
  4048.         struct evergreen_power_info *eg_pi;
  4049.         struct ni_power_info *ni_pi;
  4050.         struct atom_clock_dividers dividers;
  4051.         int ret;
  4052.  
  4053.         ni_pi = kzalloc(sizeof(struct ni_power_info), GFP_KERNEL);
  4054.         if (ni_pi == NULL)
  4055.                 return -ENOMEM;
  4056.         rdev->pm.dpm.priv = ni_pi;
  4057.         eg_pi = &ni_pi->eg;
  4058.         pi = &eg_pi->rv7xx;
  4059.  
  4060.         rv770_get_max_vddc(rdev);
  4061.  
  4062.         eg_pi->ulv.supported = false;
  4063.         pi->acpi_vddc = 0;
  4064.         eg_pi->acpi_vddci = 0;
  4065.         pi->min_vddc_in_table = 0;
  4066.         pi->max_vddc_in_table = 0;
  4067.  
  4068.         ret = r600_get_platform_caps(rdev);
  4069.         if (ret)
  4070.                 return ret;
  4071.  
  4072.         ret = ni_parse_power_table(rdev);
  4073.         if (ret)
  4074.                 return ret;
  4075.         ret = r600_parse_extended_power_table(rdev);
  4076.         if (ret)
  4077.                 return ret;
  4078.  
  4079.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries =
  4080.                 kzalloc(4 * sizeof(struct radeon_clock_voltage_dependency_entry), GFP_KERNEL);
  4081.         if (!rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries) {
  4082.                 r600_free_extended_power_table(rdev);
  4083.                 return -ENOMEM;
  4084.         }
  4085.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.count = 4;
  4086.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[0].clk = 0;
  4087.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[0].v = 0;
  4088.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[1].clk = 36000;
  4089.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[1].v = 720;
  4090.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[2].clk = 54000;
  4091.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[2].v = 810;
  4092.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[3].clk = 72000;
  4093.         rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries[3].v = 900;
  4094.  
  4095.         ni_patch_dependency_tables_based_on_leakage(rdev);
  4096.  
  4097.         if (rdev->pm.dpm.voltage_response_time == 0)
  4098.                 rdev->pm.dpm.voltage_response_time = R600_VOLTAGERESPONSETIME_DFLT;
  4099.         if (rdev->pm.dpm.backbias_response_time == 0)
  4100.                 rdev->pm.dpm.backbias_response_time = R600_BACKBIASRESPONSETIME_DFLT;
  4101.  
  4102.         ret = radeon_atom_get_clock_dividers(rdev, COMPUTE_ENGINE_PLL_PARAM,
  4103.                                              0, false, &dividers);
  4104.         if (ret)
  4105.                 pi->ref_div = dividers.ref_div + 1;
  4106.         else
  4107.                 pi->ref_div = R600_REFERENCEDIVIDER_DFLT;
  4108.  
  4109.         pi->rlp = RV770_RLP_DFLT;
  4110.         pi->rmp = RV770_RMP_DFLT;
  4111.         pi->lhp = RV770_LHP_DFLT;
  4112.         pi->lmp = RV770_LMP_DFLT;
  4113.  
  4114.         eg_pi->ats[0].rlp = RV770_RLP_DFLT;
  4115.         eg_pi->ats[0].rmp = RV770_RMP_DFLT;
  4116.         eg_pi->ats[0].lhp = RV770_LHP_DFLT;
  4117.         eg_pi->ats[0].lmp = RV770_LMP_DFLT;
  4118.  
  4119.         eg_pi->ats[1].rlp = BTC_RLP_UVD_DFLT;
  4120.         eg_pi->ats[1].rmp = BTC_RMP_UVD_DFLT;
  4121.         eg_pi->ats[1].lhp = BTC_LHP_UVD_DFLT;
  4122.         eg_pi->ats[1].lmp = BTC_LMP_UVD_DFLT;
  4123.  
  4124.         eg_pi->smu_uvd_hs = true;
  4125.  
  4126.         if (rdev->pdev->device == 0x6707) {
  4127.                 pi->mclk_strobe_mode_threshold = 55000;
  4128.                 pi->mclk_edc_enable_threshold = 55000;
  4129.                 eg_pi->mclk_edc_wr_enable_threshold = 55000;
  4130.         } else {
  4131.                 pi->mclk_strobe_mode_threshold = 40000;
  4132.                 pi->mclk_edc_enable_threshold = 40000;
  4133.                 eg_pi->mclk_edc_wr_enable_threshold = 40000;
  4134.         }
  4135.         ni_pi->mclk_rtt_mode_threshold = eg_pi->mclk_edc_wr_enable_threshold;
  4136.  
  4137.         pi->voltage_control =
  4138.                 radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_VDDC, 0);
  4139.  
  4140.         pi->mvdd_control =
  4141.                 radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_MVDDC, 0);
  4142.  
  4143.         eg_pi->vddci_control =
  4144.                 radeon_atom_is_voltage_gpio(rdev, SET_VOLTAGE_TYPE_ASIC_VDDCI, 0);
  4145.  
  4146.         rv770_get_engine_memory_ss(rdev);
  4147.  
  4148.         pi->asi = RV770_ASI_DFLT;
  4149.         pi->pasi = CYPRESS_HASI_DFLT;
  4150.         pi->vrc = CYPRESS_VRC_DFLT;
  4151.  
  4152.         pi->power_gating = false;
  4153.  
  4154.         pi->gfx_clock_gating = true;
  4155.  
  4156.         pi->mg_clock_gating = true;
  4157.         pi->mgcgtssm = true;
  4158.         eg_pi->ls_clock_gating = false;
  4159.         eg_pi->sclk_deep_sleep = false;
  4160.  
  4161.         pi->dynamic_pcie_gen2 = true;
  4162.  
  4163.         if (rdev->pm.int_thermal_type != THERMAL_TYPE_NONE)
  4164.                 pi->thermal_protection = true;
  4165.         else
  4166.                 pi->thermal_protection = false;
  4167.  
  4168.         pi->display_gap = true;
  4169.  
  4170.         pi->dcodt = true;
  4171.  
  4172.         pi->ulps = true;
  4173.  
  4174.         eg_pi->dynamic_ac_timing = true;
  4175.         eg_pi->abm = true;
  4176.         eg_pi->mcls = true;
  4177.         eg_pi->light_sleep = true;
  4178.         eg_pi->memory_transition = true;
  4179. #if defined(CONFIG_ACPI)
  4180.         eg_pi->pcie_performance_request =
  4181.                 radeon_acpi_is_pcie_performance_request_supported(rdev);
  4182. #else
  4183.         eg_pi->pcie_performance_request = false;
  4184. #endif
  4185.  
  4186.         eg_pi->dll_default_on = false;
  4187.  
  4188.         eg_pi->sclk_deep_sleep = false;
  4189.  
  4190.         pi->mclk_stutter_mode_threshold = 0;
  4191.  
  4192.         pi->sram_end = SMC_RAM_END;
  4193.  
  4194.         rdev->pm.dpm.dyn_state.mclk_sclk_ratio = 3;
  4195.         rdev->pm.dpm.dyn_state.vddc_vddci_delta = 200;
  4196.         rdev->pm.dpm.dyn_state.min_vddc_for_pcie_gen2 = 900;
  4197.         rdev->pm.dpm.dyn_state.valid_sclk_values.count = ARRAY_SIZE(btc_valid_sclk);
  4198.         rdev->pm.dpm.dyn_state.valid_sclk_values.values = btc_valid_sclk;
  4199.         rdev->pm.dpm.dyn_state.valid_mclk_values.count = 0;
  4200.         rdev->pm.dpm.dyn_state.valid_mclk_values.values = NULL;
  4201.         rdev->pm.dpm.dyn_state.sclk_mclk_delta = 12500;
  4202.  
  4203.         ni_pi->cac_data.leakage_coefficients.at = 516;
  4204.         ni_pi->cac_data.leakage_coefficients.bt = 18;
  4205.         ni_pi->cac_data.leakage_coefficients.av = 51;
  4206.         ni_pi->cac_data.leakage_coefficients.bv = 2957;
  4207.  
  4208.         switch (rdev->pdev->device) {
  4209.         case 0x6700:
  4210.         case 0x6701:
  4211.         case 0x6702:
  4212.         case 0x6703:
  4213.         case 0x6718:
  4214.                 ni_pi->cac_weights = &cac_weights_cayman_xt;
  4215.                 break;
  4216.         case 0x6705:
  4217.         case 0x6719:
  4218.         case 0x671D:
  4219.         case 0x671C:
  4220.         default:
  4221.                 ni_pi->cac_weights = &cac_weights_cayman_pro;
  4222.                 break;
  4223.         case 0x6704:
  4224.         case 0x6706:
  4225.         case 0x6707:
  4226.         case 0x6708:
  4227.         case 0x6709:
  4228.                 ni_pi->cac_weights = &cac_weights_cayman_le;
  4229.                 break;
  4230.         }
  4231.  
  4232.         if (ni_pi->cac_weights->enable_power_containment_by_default) {
  4233.                 ni_pi->enable_power_containment = true;
  4234.                 ni_pi->enable_cac = true;
  4235.                 ni_pi->enable_sq_ramping = true;
  4236.         } else {
  4237.                 ni_pi->enable_power_containment = false;
  4238.                 ni_pi->enable_cac = false;
  4239.                 ni_pi->enable_sq_ramping = false;
  4240.         }
  4241.  
  4242.         ni_pi->driver_calculate_cac_leakage = false;
  4243.         ni_pi->cac_configuration_required = true;
  4244.  
  4245.         if (ni_pi->cac_configuration_required) {
  4246.                 ni_pi->support_cac_long_term_average = true;
  4247.                 ni_pi->lta_window_size = ni_pi->cac_weights->l2_lta_window_size;
  4248.                 ni_pi->lts_truncate = ni_pi->cac_weights->lts_truncate;
  4249.         } else {
  4250.                 ni_pi->support_cac_long_term_average = false;
  4251.                 ni_pi->lta_window_size = 0;
  4252.                 ni_pi->lts_truncate = 0;
  4253.         }
  4254.  
  4255.         ni_pi->use_power_boost_limit = true;
  4256.  
  4257.         /* make sure dc limits are valid */
  4258.         if ((rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.sclk == 0) ||
  4259.             (rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc.mclk == 0))
  4260.                 rdev->pm.dpm.dyn_state.max_clock_voltage_on_dc =
  4261.                         rdev->pm.dpm.dyn_state.max_clock_voltage_on_ac;
  4262.  
  4263.         return 0;
  4264. }
  4265.  
  4266. void ni_dpm_fini(struct radeon_device *rdev)
  4267. {
  4268.         int i;
  4269.  
  4270.         for (i = 0; i < rdev->pm.dpm.num_ps; i++) {
  4271.                 kfree(rdev->pm.dpm.ps[i].ps_priv);
  4272.         }
  4273.         kfree(rdev->pm.dpm.ps);
  4274.         kfree(rdev->pm.dpm.priv);
  4275.         kfree(rdev->pm.dpm.dyn_state.vddc_dependency_on_dispclk.entries);
  4276.         r600_free_extended_power_table(rdev);
  4277. }
  4278.  
  4279. void ni_dpm_print_power_state(struct radeon_device *rdev,
  4280.                               struct radeon_ps *rps)
  4281. {
  4282.         struct ni_ps *ps = ni_get_ps(rps);
  4283.         struct rv7xx_pl *pl;
  4284.         int i;
  4285.  
  4286.         r600_dpm_print_class_info(rps->class, rps->class2);
  4287.         r600_dpm_print_cap_info(rps->caps);
  4288.         printk("\tuvd    vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
  4289.         for (i = 0; i < ps->performance_level_count; i++) {
  4290.                 pl = &ps->performance_levels[i];
  4291.                 if (rdev->family >= CHIP_TAHITI)
  4292.                         printk("\t\tpower level %d    sclk: %u mclk: %u vddc: %u vddci: %u pcie gen: %u\n",
  4293.                                i, pl->sclk, pl->mclk, pl->vddc, pl->vddci, pl->pcie_gen + 1);
  4294.                 else
  4295.                         printk("\t\tpower level %d    sclk: %u mclk: %u vddc: %u vddci: %u\n",
  4296.                                i, pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  4297.         }
  4298.         r600_dpm_print_ps_status(rdev, rps);
  4299. }
  4300.  
  4301. void ni_dpm_debugfs_print_current_performance_level(struct radeon_device *rdev,
  4302.                                                     struct seq_file *m)
  4303. {
  4304.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  4305.         struct radeon_ps *rps = &eg_pi->current_rps;
  4306.         struct ni_ps *ps = ni_get_ps(rps);
  4307.         struct rv7xx_pl *pl;
  4308.         u32 current_index =
  4309.                 (RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_STATE_INDEX_MASK) >>
  4310.                 CURRENT_STATE_INDEX_SHIFT;
  4311.  
  4312.         if (current_index >= ps->performance_level_count) {
  4313.                 seq_printf(m, "invalid dpm profile %d\n", current_index);
  4314.         } else {
  4315.                 pl = &ps->performance_levels[current_index];
  4316.                 seq_printf(m, "uvd    vclk: %d dclk: %d\n", rps->vclk, rps->dclk);
  4317.                 seq_printf(m, "power level %d    sclk: %u mclk: %u vddc: %u vddci: %u\n",
  4318.                            current_index, pl->sclk, pl->mclk, pl->vddc, pl->vddci);
  4319.         }
  4320. }
  4321.  
  4322. u32 ni_dpm_get_current_sclk(struct radeon_device *rdev)
  4323. {
  4324.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  4325.         struct radeon_ps *rps = &eg_pi->current_rps;
  4326.         struct ni_ps *ps = ni_get_ps(rps);
  4327.         struct rv7xx_pl *pl;
  4328.         u32 current_index =
  4329.                 (RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_STATE_INDEX_MASK) >>
  4330.                 CURRENT_STATE_INDEX_SHIFT;
  4331.  
  4332.         if (current_index >= ps->performance_level_count) {
  4333.                 return 0;
  4334.         } else {
  4335.                 pl = &ps->performance_levels[current_index];
  4336.                 return pl->sclk;
  4337.         }
  4338. }
  4339.  
  4340. u32 ni_dpm_get_current_mclk(struct radeon_device *rdev)
  4341. {
  4342.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  4343.         struct radeon_ps *rps = &eg_pi->current_rps;
  4344.         struct ni_ps *ps = ni_get_ps(rps);
  4345.         struct rv7xx_pl *pl;
  4346.         u32 current_index =
  4347.                 (RREG32(TARGET_AND_CURRENT_PROFILE_INDEX) & CURRENT_STATE_INDEX_MASK) >>
  4348.                 CURRENT_STATE_INDEX_SHIFT;
  4349.  
  4350.         if (current_index >= ps->performance_level_count) {
  4351.                 return 0;
  4352.         } else {
  4353.                 pl = &ps->performance_levels[current_index];
  4354.                 return pl->mclk;
  4355.         }
  4356. }
  4357.  
  4358. u32 ni_dpm_get_sclk(struct radeon_device *rdev, bool low)
  4359. {
  4360.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  4361.         struct ni_ps *requested_state = ni_get_ps(&eg_pi->requested_rps);
  4362.  
  4363.         if (low)
  4364.                 return requested_state->performance_levels[0].sclk;
  4365.         else
  4366.                 return requested_state->performance_levels[requested_state->performance_level_count - 1].sclk;
  4367. }
  4368.  
  4369. u32 ni_dpm_get_mclk(struct radeon_device *rdev, bool low)
  4370. {
  4371.         struct evergreen_power_info *eg_pi = evergreen_get_pi(rdev);
  4372.         struct ni_ps *requested_state = ni_get_ps(&eg_pi->requested_rps);
  4373.  
  4374.         if (low)
  4375.                 return requested_state->performance_levels[0].mclk;
  4376.         else
  4377.                 return requested_state->performance_levels[requested_state->performance_level_count - 1].mclk;
  4378. }
  4379.  
  4380.