pm_domains.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897
  1. /*
  2. * Rockchip Generic power domain support.
  3. *
  4. * Copyright (c) 2015 ROCKCHIP, Co. Ltd.
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. */
  10. #include <linux/io.h>
  11. #include <linux/iopoll.h>
  12. #include <linux/err.h>
  13. #include <linux/pm_clock.h>
  14. #include <linux/pm_domain.h>
  15. #include <linux/of_address.h>
  16. #include <linux/of_platform.h>
  17. #include <linux/clk.h>
  18. #include <linux/regmap.h>
  19. #include <linux/mfd/syscon.h>
  20. #include <dt-bindings/power/rk3288-power.h>
  21. #include <dt-bindings/power/rk3328-power.h>
  22. #include <dt-bindings/power/rk3366-power.h>
  23. #include <dt-bindings/power/rk3368-power.h>
  24. #include <dt-bindings/power/rk3399-power.h>
  25. struct rockchip_domain_info {
  26. int pwr_mask;
  27. int status_mask;
  28. int req_mask;
  29. int idle_mask;
  30. int ack_mask;
  31. bool active_wakeup;
  32. int pwr_w_mask;
  33. int req_w_mask;
  34. };
  35. struct rockchip_pmu_info {
  36. u32 pwr_offset;
  37. u32 status_offset;
  38. u32 req_offset;
  39. u32 idle_offset;
  40. u32 ack_offset;
  41. u32 core_pwrcnt_offset;
  42. u32 gpu_pwrcnt_offset;
  43. unsigned int core_power_transition_time;
  44. unsigned int gpu_power_transition_time;
  45. int num_domains;
  46. const struct rockchip_domain_info *domain_info;
  47. };
  48. #define MAX_QOS_REGS_NUM 5
  49. #define QOS_PRIORITY 0x08
  50. #define QOS_MODE 0x0c
  51. #define QOS_BANDWIDTH 0x10
  52. #define QOS_SATURATION 0x14
  53. #define QOS_EXTCONTROL 0x18
  54. struct rockchip_pm_domain {
  55. struct generic_pm_domain genpd;
  56. const struct rockchip_domain_info *info;
  57. struct rockchip_pmu *pmu;
  58. int num_qos;
  59. struct regmap **qos_regmap;
  60. u32 *qos_save_regs[MAX_QOS_REGS_NUM];
  61. int num_clks;
  62. struct clk *clks[];
  63. };
  64. struct rockchip_pmu {
  65. struct device *dev;
  66. struct regmap *regmap;
  67. const struct rockchip_pmu_info *info;
  68. struct mutex mutex; /* mutex lock for pmu */
  69. struct genpd_onecell_data genpd_data;
  70. struct generic_pm_domain *domains[];
  71. };
  72. #define to_rockchip_pd(gpd) container_of(gpd, struct rockchip_pm_domain, genpd)
  73. #define DOMAIN(pwr, status, req, idle, ack, wakeup) \
  74. { \
  75. .pwr_mask = (pwr >= 0) ? BIT(pwr) : 0, \
  76. .status_mask = (status >= 0) ? BIT(status) : 0, \
  77. .req_mask = (req >= 0) ? BIT(req) : 0, \
  78. .idle_mask = (idle >= 0) ? BIT(idle) : 0, \
  79. .ack_mask = (ack >= 0) ? BIT(ack) : 0, \
  80. .active_wakeup = wakeup, \
  81. }
  82. #define DOMAIN_M(pwr, status, req, idle, ack, wakeup) \
  83. { \
  84. .pwr_w_mask = (pwr >= 0) ? BIT(pwr + 16) : 0, \
  85. .pwr_mask = (pwr >= 0) ? BIT(pwr) : 0, \
  86. .status_mask = (status >= 0) ? BIT(status) : 0, \
  87. .req_w_mask = (req >= 0) ? BIT(req + 16) : 0, \
  88. .req_mask = (req >= 0) ? BIT(req) : 0, \
  89. .idle_mask = (idle >= 0) ? BIT(idle) : 0, \
  90. .ack_mask = (ack >= 0) ? BIT(ack) : 0, \
  91. .active_wakeup = wakeup, \
  92. }
  93. #define DOMAIN_RK3288(pwr, status, req, wakeup) \
  94. DOMAIN(pwr, status, req, req, (req) + 16, wakeup)
  95. #define DOMAIN_RK3328(pwr, status, req, wakeup) \
  96. DOMAIN_M(pwr, pwr, req, (req) + 10, req, wakeup)
  97. #define DOMAIN_RK3368(pwr, status, req, wakeup) \
  98. DOMAIN(pwr, status, req, (req) + 16, req, wakeup)
  99. #define DOMAIN_RK3399(pwr, status, req, wakeup) \
  100. DOMAIN(pwr, status, req, req, req, wakeup)
  101. static bool rockchip_pmu_domain_is_idle(struct rockchip_pm_domain *pd)
  102. {
  103. struct rockchip_pmu *pmu = pd->pmu;
  104. const struct rockchip_domain_info *pd_info = pd->info;
  105. unsigned int val;
  106. regmap_read(pmu->regmap, pmu->info->idle_offset, &val);
  107. return (val & pd_info->idle_mask) == pd_info->idle_mask;
  108. }
  109. static unsigned int rockchip_pmu_read_ack(struct rockchip_pmu *pmu)
  110. {
  111. unsigned int val;
  112. regmap_read(pmu->regmap, pmu->info->ack_offset, &val);
  113. return val;
  114. }
  115. static int rockchip_pmu_set_idle_request(struct rockchip_pm_domain *pd,
  116. bool idle)
  117. {
  118. const struct rockchip_domain_info *pd_info = pd->info;
  119. struct generic_pm_domain *genpd = &pd->genpd;
  120. struct rockchip_pmu *pmu = pd->pmu;
  121. unsigned int target_ack;
  122. unsigned int val;
  123. bool is_idle;
  124. int ret;
  125. if (pd_info->req_mask == 0)
  126. return 0;
  127. else if (pd_info->req_w_mask)
  128. regmap_write(pmu->regmap, pmu->info->req_offset,
  129. idle ? (pd_info->req_mask | pd_info->req_w_mask) :
  130. pd_info->req_w_mask);
  131. else
  132. regmap_update_bits(pmu->regmap, pmu->info->req_offset,
  133. pd_info->req_mask, idle ? -1U : 0);
  134. dsb(sy);
  135. /* Wait util idle_ack = 1 */
  136. target_ack = idle ? pd_info->ack_mask : 0;
  137. ret = readx_poll_timeout_atomic(rockchip_pmu_read_ack, pmu, val,
  138. (val & pd_info->ack_mask) == target_ack,
  139. 0, 10000);
  140. if (ret) {
  141. dev_err(pmu->dev,
  142. "failed to get ack on domain '%s', val=0x%x\n",
  143. genpd->name, val);
  144. return ret;
  145. }
  146. ret = readx_poll_timeout_atomic(rockchip_pmu_domain_is_idle, pd,
  147. is_idle, is_idle == idle, 0, 10000);
  148. if (ret) {
  149. dev_err(pmu->dev,
  150. "failed to set idle on domain '%s', val=%d\n",
  151. genpd->name, is_idle);
  152. return ret;
  153. }
  154. return 0;
  155. }
  156. static int rockchip_pmu_save_qos(struct rockchip_pm_domain *pd)
  157. {
  158. int i;
  159. for (i = 0; i < pd->num_qos; i++) {
  160. regmap_read(pd->qos_regmap[i],
  161. QOS_PRIORITY,
  162. &pd->qos_save_regs[0][i]);
  163. regmap_read(pd->qos_regmap[i],
  164. QOS_MODE,
  165. &pd->qos_save_regs[1][i]);
  166. regmap_read(pd->qos_regmap[i],
  167. QOS_BANDWIDTH,
  168. &pd->qos_save_regs[2][i]);
  169. regmap_read(pd->qos_regmap[i],
  170. QOS_SATURATION,
  171. &pd->qos_save_regs[3][i]);
  172. regmap_read(pd->qos_regmap[i],
  173. QOS_EXTCONTROL,
  174. &pd->qos_save_regs[4][i]);
  175. }
  176. return 0;
  177. }
  178. static int rockchip_pmu_restore_qos(struct rockchip_pm_domain *pd)
  179. {
  180. int i;
  181. for (i = 0; i < pd->num_qos; i++) {
  182. regmap_write(pd->qos_regmap[i],
  183. QOS_PRIORITY,
  184. pd->qos_save_regs[0][i]);
  185. regmap_write(pd->qos_regmap[i],
  186. QOS_MODE,
  187. pd->qos_save_regs[1][i]);
  188. regmap_write(pd->qos_regmap[i],
  189. QOS_BANDWIDTH,
  190. pd->qos_save_regs[2][i]);
  191. regmap_write(pd->qos_regmap[i],
  192. QOS_SATURATION,
  193. pd->qos_save_regs[3][i]);
  194. regmap_write(pd->qos_regmap[i],
  195. QOS_EXTCONTROL,
  196. pd->qos_save_regs[4][i]);
  197. }
  198. return 0;
  199. }
  200. static bool rockchip_pmu_domain_is_on(struct rockchip_pm_domain *pd)
  201. {
  202. struct rockchip_pmu *pmu = pd->pmu;
  203. unsigned int val;
  204. /* check idle status for idle-only domains */
  205. if (pd->info->status_mask == 0)
  206. return !rockchip_pmu_domain_is_idle(pd);
  207. regmap_read(pmu->regmap, pmu->info->status_offset, &val);
  208. /* 1'b0: power on, 1'b1: power off */
  209. return !(val & pd->info->status_mask);
  210. }
  211. static void rockchip_do_pmu_set_power_domain(struct rockchip_pm_domain *pd,
  212. bool on)
  213. {
  214. struct rockchip_pmu *pmu = pd->pmu;
  215. struct generic_pm_domain *genpd = &pd->genpd;
  216. bool is_on;
  217. if (pd->info->pwr_mask == 0)
  218. return;
  219. else if (pd->info->pwr_w_mask)
  220. regmap_write(pmu->regmap, pmu->info->pwr_offset,
  221. on ? pd->info->pwr_mask :
  222. (pd->info->pwr_mask | pd->info->pwr_w_mask));
  223. else
  224. regmap_update_bits(pmu->regmap, pmu->info->pwr_offset,
  225. pd->info->pwr_mask, on ? 0 : -1U);
  226. dsb(sy);
  227. if (readx_poll_timeout_atomic(rockchip_pmu_domain_is_on, pd, is_on,
  228. is_on == on, 0, 10000)) {
  229. dev_err(pmu->dev,
  230. "failed to set domain '%s', val=%d\n",
  231. genpd->name, is_on);
  232. return;
  233. }
  234. }
  235. static int rockchip_pd_power(struct rockchip_pm_domain *pd, bool power_on)
  236. {
  237. int i;
  238. mutex_lock(&pd->pmu->mutex);
  239. if (rockchip_pmu_domain_is_on(pd) != power_on) {
  240. for (i = 0; i < pd->num_clks; i++)
  241. clk_enable(pd->clks[i]);
  242. if (!power_on) {
  243. rockchip_pmu_save_qos(pd);
  244. /* if powering down, idle request to NIU first */
  245. rockchip_pmu_set_idle_request(pd, true);
  246. }
  247. rockchip_do_pmu_set_power_domain(pd, power_on);
  248. if (power_on) {
  249. /* if powering up, leave idle mode */
  250. rockchip_pmu_set_idle_request(pd, false);
  251. rockchip_pmu_restore_qos(pd);
  252. }
  253. for (i = pd->num_clks - 1; i >= 0; i--)
  254. clk_disable(pd->clks[i]);
  255. }
  256. mutex_unlock(&pd->pmu->mutex);
  257. return 0;
  258. }
  259. static int rockchip_pd_power_on(struct generic_pm_domain *domain)
  260. {
  261. struct rockchip_pm_domain *pd = to_rockchip_pd(domain);
  262. return rockchip_pd_power(pd, true);
  263. }
  264. static int rockchip_pd_power_off(struct generic_pm_domain *domain)
  265. {
  266. struct rockchip_pm_domain *pd = to_rockchip_pd(domain);
  267. return rockchip_pd_power(pd, false);
  268. }
  269. static int rockchip_pd_attach_dev(struct generic_pm_domain *genpd,
  270. struct device *dev)
  271. {
  272. struct clk *clk;
  273. int i;
  274. int error;
  275. dev_dbg(dev, "attaching to power domain '%s'\n", genpd->name);
  276. error = pm_clk_create(dev);
  277. if (error) {
  278. dev_err(dev, "pm_clk_create failed %d\n", error);
  279. return error;
  280. }
  281. i = 0;
  282. while ((clk = of_clk_get(dev->of_node, i++)) && !IS_ERR(clk)) {
  283. dev_dbg(dev, "adding clock '%pC' to list of PM clocks\n", clk);
  284. error = pm_clk_add_clk(dev, clk);
  285. if (error) {
  286. dev_err(dev, "pm_clk_add_clk failed %d\n", error);
  287. clk_put(clk);
  288. pm_clk_destroy(dev);
  289. return error;
  290. }
  291. }
  292. return 0;
  293. }
  294. static void rockchip_pd_detach_dev(struct generic_pm_domain *genpd,
  295. struct device *dev)
  296. {
  297. dev_dbg(dev, "detaching from power domain '%s'\n", genpd->name);
  298. pm_clk_destroy(dev);
  299. }
  300. static bool rockchip_active_wakeup(struct device *dev)
  301. {
  302. struct generic_pm_domain *genpd;
  303. struct rockchip_pm_domain *pd;
  304. genpd = pd_to_genpd(dev->pm_domain);
  305. pd = container_of(genpd, struct rockchip_pm_domain, genpd);
  306. return pd->info->active_wakeup;
  307. }
  308. static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
  309. struct device_node *node)
  310. {
  311. const struct rockchip_domain_info *pd_info;
  312. struct rockchip_pm_domain *pd;
  313. struct device_node *qos_node;
  314. struct clk *clk;
  315. int clk_cnt;
  316. int i, j;
  317. u32 id;
  318. int error;
  319. error = of_property_read_u32(node, "reg", &id);
  320. if (error) {
  321. dev_err(pmu->dev,
  322. "%s: failed to retrieve domain id (reg): %d\n",
  323. node->name, error);
  324. return -EINVAL;
  325. }
  326. if (id >= pmu->info->num_domains) {
  327. dev_err(pmu->dev, "%s: invalid domain id %d\n",
  328. node->name, id);
  329. return -EINVAL;
  330. }
  331. pd_info = &pmu->info->domain_info[id];
  332. if (!pd_info) {
  333. dev_err(pmu->dev, "%s: undefined domain id %d\n",
  334. node->name, id);
  335. return -EINVAL;
  336. }
  337. clk_cnt = of_count_phandle_with_args(node, "clocks", "#clock-cells");
  338. pd = devm_kzalloc(pmu->dev,
  339. sizeof(*pd) + clk_cnt * sizeof(pd->clks[0]),
  340. GFP_KERNEL);
  341. if (!pd)
  342. return -ENOMEM;
  343. pd->info = pd_info;
  344. pd->pmu = pmu;
  345. for (i = 0; i < clk_cnt; i++) {
  346. clk = of_clk_get(node, i);
  347. if (IS_ERR(clk)) {
  348. error = PTR_ERR(clk);
  349. dev_err(pmu->dev,
  350. "%s: failed to get clk at index %d: %d\n",
  351. node->name, i, error);
  352. goto err_out;
  353. }
  354. error = clk_prepare(clk);
  355. if (error) {
  356. dev_err(pmu->dev,
  357. "%s: failed to prepare clk %pC (index %d): %d\n",
  358. node->name, clk, i, error);
  359. clk_put(clk);
  360. goto err_out;
  361. }
  362. pd->clks[pd->num_clks++] = clk;
  363. dev_dbg(pmu->dev, "added clock '%pC' to domain '%s'\n",
  364. clk, node->name);
  365. }
  366. pd->num_qos = of_count_phandle_with_args(node, "pm_qos",
  367. NULL);
  368. if (pd->num_qos > 0) {
  369. pd->qos_regmap = devm_kcalloc(pmu->dev, pd->num_qos,
  370. sizeof(*pd->qos_regmap),
  371. GFP_KERNEL);
  372. if (!pd->qos_regmap) {
  373. error = -ENOMEM;
  374. goto err_out;
  375. }
  376. for (j = 0; j < MAX_QOS_REGS_NUM; j++) {
  377. pd->qos_save_regs[j] = devm_kcalloc(pmu->dev,
  378. pd->num_qos,
  379. sizeof(u32),
  380. GFP_KERNEL);
  381. if (!pd->qos_save_regs[j]) {
  382. error = -ENOMEM;
  383. goto err_out;
  384. }
  385. }
  386. for (j = 0; j < pd->num_qos; j++) {
  387. qos_node = of_parse_phandle(node, "pm_qos", j);
  388. if (!qos_node) {
  389. error = -ENODEV;
  390. goto err_out;
  391. }
  392. pd->qos_regmap[j] = syscon_node_to_regmap(qos_node);
  393. if (IS_ERR(pd->qos_regmap[j])) {
  394. error = -ENODEV;
  395. of_node_put(qos_node);
  396. goto err_out;
  397. }
  398. of_node_put(qos_node);
  399. }
  400. }
  401. error = rockchip_pd_power(pd, true);
  402. if (error) {
  403. dev_err(pmu->dev,
  404. "failed to power on domain '%s': %d\n",
  405. node->name, error);
  406. goto err_out;
  407. }
  408. pd->genpd.name = node->name;
  409. pd->genpd.power_off = rockchip_pd_power_off;
  410. pd->genpd.power_on = rockchip_pd_power_on;
  411. pd->genpd.attach_dev = rockchip_pd_attach_dev;
  412. pd->genpd.detach_dev = rockchip_pd_detach_dev;
  413. pd->genpd.dev_ops.active_wakeup = rockchip_active_wakeup;
  414. pd->genpd.flags = GENPD_FLAG_PM_CLK;
  415. pm_genpd_init(&pd->genpd, NULL, false);
  416. pmu->genpd_data.domains[id] = &pd->genpd;
  417. return 0;
  418. err_out:
  419. while (--i >= 0) {
  420. clk_unprepare(pd->clks[i]);
  421. clk_put(pd->clks[i]);
  422. }
  423. return error;
  424. }
  425. static void rockchip_pm_remove_one_domain(struct rockchip_pm_domain *pd)
  426. {
  427. int i, ret;
  428. /*
  429. * We're in the error cleanup already, so we only complain,
  430. * but won't emit another error on top of the original one.
  431. */
  432. ret = pm_genpd_remove(&pd->genpd);
  433. if (ret < 0)
  434. dev_err(pd->pmu->dev, "failed to remove domain '%s' : %d - state may be inconsistent\n",
  435. pd->genpd.name, ret);
  436. for (i = 0; i < pd->num_clks; i++) {
  437. clk_unprepare(pd->clks[i]);
  438. clk_put(pd->clks[i]);
  439. }
  440. /* protect the zeroing of pm->num_clks */
  441. mutex_lock(&pd->pmu->mutex);
  442. pd->num_clks = 0;
  443. mutex_unlock(&pd->pmu->mutex);
  444. /* devm will free our memory */
  445. }
  446. static void rockchip_pm_domain_cleanup(struct rockchip_pmu *pmu)
  447. {
  448. struct generic_pm_domain *genpd;
  449. struct rockchip_pm_domain *pd;
  450. int i;
  451. for (i = 0; i < pmu->genpd_data.num_domains; i++) {
  452. genpd = pmu->genpd_data.domains[i];
  453. if (genpd) {
  454. pd = to_rockchip_pd(genpd);
  455. rockchip_pm_remove_one_domain(pd);
  456. }
  457. }
  458. /* devm will free our memory */
  459. }
  460. static void rockchip_configure_pd_cnt(struct rockchip_pmu *pmu,
  461. u32 domain_reg_offset,
  462. unsigned int count)
  463. {
  464. /* First configure domain power down transition count ... */
  465. regmap_write(pmu->regmap, domain_reg_offset, count);
  466. /* ... and then power up count. */
  467. regmap_write(pmu->regmap, domain_reg_offset + 4, count);
  468. }
  469. static int rockchip_pm_add_subdomain(struct rockchip_pmu *pmu,
  470. struct device_node *parent)
  471. {
  472. struct device_node *np;
  473. struct generic_pm_domain *child_domain, *parent_domain;
  474. int error;
  475. for_each_child_of_node(parent, np) {
  476. u32 idx;
  477. error = of_property_read_u32(parent, "reg", &idx);
  478. if (error) {
  479. dev_err(pmu->dev,
  480. "%s: failed to retrieve domain id (reg): %d\n",
  481. parent->name, error);
  482. goto err_out;
  483. }
  484. parent_domain = pmu->genpd_data.domains[idx];
  485. error = rockchip_pm_add_one_domain(pmu, np);
  486. if (error) {
  487. dev_err(pmu->dev, "failed to handle node %s: %d\n",
  488. np->name, error);
  489. goto err_out;
  490. }
  491. error = of_property_read_u32(np, "reg", &idx);
  492. if (error) {
  493. dev_err(pmu->dev,
  494. "%s: failed to retrieve domain id (reg): %d\n",
  495. np->name, error);
  496. goto err_out;
  497. }
  498. child_domain = pmu->genpd_data.domains[idx];
  499. error = pm_genpd_add_subdomain(parent_domain, child_domain);
  500. if (error) {
  501. dev_err(pmu->dev, "%s failed to add subdomain %s: %d\n",
  502. parent_domain->name, child_domain->name, error);
  503. goto err_out;
  504. } else {
  505. dev_dbg(pmu->dev, "%s add subdomain: %s\n",
  506. parent_domain->name, child_domain->name);
  507. }
  508. rockchip_pm_add_subdomain(pmu, np);
  509. }
  510. return 0;
  511. err_out:
  512. of_node_put(np);
  513. return error;
  514. }
  515. static int rockchip_pm_domain_probe(struct platform_device *pdev)
  516. {
  517. struct device *dev = &pdev->dev;
  518. struct device_node *np = dev->of_node;
  519. struct device_node *node;
  520. struct device *parent;
  521. struct rockchip_pmu *pmu;
  522. const struct of_device_id *match;
  523. const struct rockchip_pmu_info *pmu_info;
  524. int error;
  525. if (!np) {
  526. dev_err(dev, "device tree node not found\n");
  527. return -ENODEV;
  528. }
  529. match = of_match_device(dev->driver->of_match_table, dev);
  530. if (!match || !match->data) {
  531. dev_err(dev, "missing pmu data\n");
  532. return -EINVAL;
  533. }
  534. pmu_info = match->data;
  535. pmu = devm_kzalloc(dev,
  536. sizeof(*pmu) +
  537. pmu_info->num_domains * sizeof(pmu->domains[0]),
  538. GFP_KERNEL);
  539. if (!pmu)
  540. return -ENOMEM;
  541. pmu->dev = &pdev->dev;
  542. mutex_init(&pmu->mutex);
  543. pmu->info = pmu_info;
  544. pmu->genpd_data.domains = pmu->domains;
  545. pmu->genpd_data.num_domains = pmu_info->num_domains;
  546. parent = dev->parent;
  547. if (!parent) {
  548. dev_err(dev, "no parent for syscon devices\n");
  549. return -ENODEV;
  550. }
  551. pmu->regmap = syscon_node_to_regmap(parent->of_node);
  552. if (IS_ERR(pmu->regmap)) {
  553. dev_err(dev, "no regmap available\n");
  554. return PTR_ERR(pmu->regmap);
  555. }
  556. /*
  557. * Configure power up and down transition delays for CORE
  558. * and GPU domains.
  559. */
  560. if (pmu_info->core_power_transition_time)
  561. rockchip_configure_pd_cnt(pmu, pmu_info->core_pwrcnt_offset,
  562. pmu_info->core_power_transition_time);
  563. if (pmu_info->gpu_pwrcnt_offset)
  564. rockchip_configure_pd_cnt(pmu, pmu_info->gpu_pwrcnt_offset,
  565. pmu_info->gpu_power_transition_time);
  566. error = -ENODEV;
  567. for_each_available_child_of_node(np, node) {
  568. error = rockchip_pm_add_one_domain(pmu, node);
  569. if (error) {
  570. dev_err(dev, "failed to handle node %s: %d\n",
  571. node->name, error);
  572. of_node_put(node);
  573. goto err_out;
  574. }
  575. error = rockchip_pm_add_subdomain(pmu, node);
  576. if (error < 0) {
  577. dev_err(dev, "failed to handle subdomain node %s: %d\n",
  578. node->name, error);
  579. of_node_put(node);
  580. goto err_out;
  581. }
  582. }
  583. if (error) {
  584. dev_dbg(dev, "no power domains defined\n");
  585. goto err_out;
  586. }
  587. error = of_genpd_add_provider_onecell(np, &pmu->genpd_data);
  588. if (error) {
  589. dev_err(dev, "failed to add provider: %d\n", error);
  590. goto err_out;
  591. }
  592. return 0;
  593. err_out:
  594. rockchip_pm_domain_cleanup(pmu);
  595. return error;
  596. }
  597. static const struct rockchip_domain_info rk3288_pm_domains[] = {
  598. [RK3288_PD_VIO] = DOMAIN_RK3288(7, 7, 4, false),
  599. [RK3288_PD_HEVC] = DOMAIN_RK3288(14, 10, 9, false),
  600. [RK3288_PD_VIDEO] = DOMAIN_RK3288(8, 8, 3, false),
  601. [RK3288_PD_GPU] = DOMAIN_RK3288(9, 9, 2, false),
  602. };
  603. static const struct rockchip_domain_info rk3328_pm_domains[] = {
  604. [RK3328_PD_CORE] = DOMAIN_RK3328(-1, 0, 0, false),
  605. [RK3328_PD_GPU] = DOMAIN_RK3328(-1, 1, 1, false),
  606. [RK3328_PD_BUS] = DOMAIN_RK3328(-1, 2, 2, true),
  607. [RK3328_PD_MSCH] = DOMAIN_RK3328(-1, 3, 3, true),
  608. [RK3328_PD_PERI] = DOMAIN_RK3328(-1, 4, 4, true),
  609. [RK3328_PD_VIDEO] = DOMAIN_RK3328(-1, 5, 5, false),
  610. [RK3328_PD_HEVC] = DOMAIN_RK3328(-1, 6, 6, false),
  611. [RK3328_PD_VIO] = DOMAIN_RK3328(-1, 8, 8, false),
  612. [RK3328_PD_VPU] = DOMAIN_RK3328(-1, 9, 9, false),
  613. };
  614. static const struct rockchip_domain_info rk3366_pm_domains[] = {
  615. [RK3366_PD_PERI] = DOMAIN_RK3368(10, 10, 6, true),
  616. [RK3366_PD_VIO] = DOMAIN_RK3368(14, 14, 8, false),
  617. [RK3366_PD_VIDEO] = DOMAIN_RK3368(13, 13, 7, false),
  618. [RK3366_PD_RKVDEC] = DOMAIN_RK3368(11, 11, 7, false),
  619. [RK3366_PD_WIFIBT] = DOMAIN_RK3368(8, 8, 9, false),
  620. [RK3366_PD_VPU] = DOMAIN_RK3368(12, 12, 7, false),
  621. [RK3366_PD_GPU] = DOMAIN_RK3368(15, 15, 2, false),
  622. };
  623. static const struct rockchip_domain_info rk3368_pm_domains[] = {
  624. [RK3368_PD_PERI] = DOMAIN_RK3368(13, 12, 6, true),
  625. [RK3368_PD_VIO] = DOMAIN_RK3368(15, 14, 8, false),
  626. [RK3368_PD_VIDEO] = DOMAIN_RK3368(14, 13, 7, false),
  627. [RK3368_PD_GPU_0] = DOMAIN_RK3368(16, 15, 2, false),
  628. [RK3368_PD_GPU_1] = DOMAIN_RK3368(17, 16, 2, false),
  629. };
  630. static const struct rockchip_domain_info rk3399_pm_domains[] = {
  631. [RK3399_PD_TCPD0] = DOMAIN_RK3399(8, 8, -1, false),
  632. [RK3399_PD_TCPD1] = DOMAIN_RK3399(9, 9, -1, false),
  633. [RK3399_PD_CCI] = DOMAIN_RK3399(10, 10, -1, true),
  634. [RK3399_PD_CCI0] = DOMAIN_RK3399(-1, -1, 15, true),
  635. [RK3399_PD_CCI1] = DOMAIN_RK3399(-1, -1, 16, true),
  636. [RK3399_PD_PERILP] = DOMAIN_RK3399(11, 11, 1, true),
  637. [RK3399_PD_PERIHP] = DOMAIN_RK3399(12, 12, 2, true),
  638. [RK3399_PD_CENTER] = DOMAIN_RK3399(13, 13, 14, true),
  639. [RK3399_PD_VIO] = DOMAIN_RK3399(14, 14, 17, false),
  640. [RK3399_PD_GPU] = DOMAIN_RK3399(15, 15, 0, false),
  641. [RK3399_PD_VCODEC] = DOMAIN_RK3399(16, 16, 3, false),
  642. [RK3399_PD_VDU] = DOMAIN_RK3399(17, 17, 4, false),
  643. [RK3399_PD_RGA] = DOMAIN_RK3399(18, 18, 5, false),
  644. [RK3399_PD_IEP] = DOMAIN_RK3399(19, 19, 6, false),
  645. [RK3399_PD_VO] = DOMAIN_RK3399(20, 20, -1, false),
  646. [RK3399_PD_VOPB] = DOMAIN_RK3399(-1, -1, 7, false),
  647. [RK3399_PD_VOPL] = DOMAIN_RK3399(-1, -1, 8, false),
  648. [RK3399_PD_ISP0] = DOMAIN_RK3399(22, 22, 9, false),
  649. [RK3399_PD_ISP1] = DOMAIN_RK3399(23, 23, 10, false),
  650. [RK3399_PD_HDCP] = DOMAIN_RK3399(24, 24, 11, false),
  651. [RK3399_PD_GMAC] = DOMAIN_RK3399(25, 25, 23, true),
  652. [RK3399_PD_EMMC] = DOMAIN_RK3399(26, 26, 24, true),
  653. [RK3399_PD_USB3] = DOMAIN_RK3399(27, 27, 12, true),
  654. [RK3399_PD_EDP] = DOMAIN_RK3399(28, 28, 22, false),
  655. [RK3399_PD_GIC] = DOMAIN_RK3399(29, 29, 27, true),
  656. [RK3399_PD_SD] = DOMAIN_RK3399(30, 30, 28, true),
  657. [RK3399_PD_SDIOAUDIO] = DOMAIN_RK3399(31, 31, 29, true),
  658. };
  659. static const struct rockchip_pmu_info rk3288_pmu = {
  660. .pwr_offset = 0x08,
  661. .status_offset = 0x0c,
  662. .req_offset = 0x10,
  663. .idle_offset = 0x14,
  664. .ack_offset = 0x14,
  665. .core_pwrcnt_offset = 0x34,
  666. .gpu_pwrcnt_offset = 0x3c,
  667. .core_power_transition_time = 24, /* 1us */
  668. .gpu_power_transition_time = 24, /* 1us */
  669. .num_domains = ARRAY_SIZE(rk3288_pm_domains),
  670. .domain_info = rk3288_pm_domains,
  671. };
  672. static const struct rockchip_pmu_info rk3328_pmu = {
  673. .req_offset = 0x414,
  674. .idle_offset = 0x484,
  675. .ack_offset = 0x484,
  676. .num_domains = ARRAY_SIZE(rk3328_pm_domains),
  677. .domain_info = rk3328_pm_domains,
  678. };
  679. static const struct rockchip_pmu_info rk3366_pmu = {
  680. .pwr_offset = 0x0c,
  681. .status_offset = 0x10,
  682. .req_offset = 0x3c,
  683. .idle_offset = 0x40,
  684. .ack_offset = 0x40,
  685. .core_pwrcnt_offset = 0x48,
  686. .gpu_pwrcnt_offset = 0x50,
  687. .core_power_transition_time = 24,
  688. .gpu_power_transition_time = 24,
  689. .num_domains = ARRAY_SIZE(rk3366_pm_domains),
  690. .domain_info = rk3366_pm_domains,
  691. };
  692. static const struct rockchip_pmu_info rk3368_pmu = {
  693. .pwr_offset = 0x0c,
  694. .status_offset = 0x10,
  695. .req_offset = 0x3c,
  696. .idle_offset = 0x40,
  697. .ack_offset = 0x40,
  698. .core_pwrcnt_offset = 0x48,
  699. .gpu_pwrcnt_offset = 0x50,
  700. .core_power_transition_time = 24,
  701. .gpu_power_transition_time = 24,
  702. .num_domains = ARRAY_SIZE(rk3368_pm_domains),
  703. .domain_info = rk3368_pm_domains,
  704. };
  705. static const struct rockchip_pmu_info rk3399_pmu = {
  706. .pwr_offset = 0x14,
  707. .status_offset = 0x18,
  708. .req_offset = 0x60,
  709. .idle_offset = 0x64,
  710. .ack_offset = 0x68,
  711. /* ARM Trusted Firmware manages power transition times */
  712. .num_domains = ARRAY_SIZE(rk3399_pm_domains),
  713. .domain_info = rk3399_pm_domains,
  714. };
  715. static const struct of_device_id rockchip_pm_domain_dt_match[] = {
  716. {
  717. .compatible = "rockchip,rk3288-power-controller",
  718. .data = (void *)&rk3288_pmu,
  719. },
  720. {
  721. .compatible = "rockchip,rk3328-power-controller",
  722. .data = (void *)&rk3328_pmu,
  723. },
  724. {
  725. .compatible = "rockchip,rk3366-power-controller",
  726. .data = (void *)&rk3366_pmu,
  727. },
  728. {
  729. .compatible = "rockchip,rk3368-power-controller",
  730. .data = (void *)&rk3368_pmu,
  731. },
  732. {
  733. .compatible = "rockchip,rk3399-power-controller",
  734. .data = (void *)&rk3399_pmu,
  735. },
  736. { /* sentinel */ },
  737. };
  738. static struct platform_driver rockchip_pm_domain_driver = {
  739. .probe = rockchip_pm_domain_probe,
  740. .driver = {
  741. .name = "rockchip-pm-domain",
  742. .of_match_table = rockchip_pm_domain_dt_match,
  743. /*
  744. * We can't forcibly eject devices form power domain,
  745. * so we can't really remove power domains once they
  746. * were added.
  747. */
  748. .suppress_bind_attrs = true,
  749. },
  750. };
  751. static int __init rockchip_pm_domain_drv_register(void)
  752. {
  753. return platform_driver_register(&rockchip_pm_domain_driver);
  754. }
  755. postcore_initcall(rockchip_pm_domain_drv_register);