Lines Matching refs:ddata
107 static void sysc_parse_dts_quirks(struct sysc *ddata, struct device_node *np,
110 static void sysc_write(struct sysc *ddata, int offset, u32 value) in sysc_write() argument
112 if (ddata->cfg.quirks & SYSC_QUIRK_16BIT) { in sysc_write()
113 writew_relaxed(value & 0xffff, ddata->module_va + offset); in sysc_write()
116 if (ddata->offsets[SYSC_REVISION] >= 0 && in sysc_write()
117 offset == ddata->offsets[SYSC_REVISION]) { in sysc_write()
120 writew_relaxed(hi, ddata->module_va + offset + 4); in sysc_write()
126 writel_relaxed(value, ddata->module_va + offset); in sysc_write()
129 static u32 sysc_read(struct sysc *ddata, int offset) in sysc_read() argument
131 if (ddata->cfg.quirks & SYSC_QUIRK_16BIT) { in sysc_read()
134 val = readw_relaxed(ddata->module_va + offset); in sysc_read()
137 if (ddata->offsets[SYSC_REVISION] >= 0 && in sysc_read()
138 offset == ddata->offsets[SYSC_REVISION]) { in sysc_read()
139 u16 tmp = readw_relaxed(ddata->module_va + offset + 4); in sysc_read()
147 return readl_relaxed(ddata->module_va + offset); in sysc_read()
150 static bool sysc_opt_clks_needed(struct sysc *ddata) in sysc_opt_clks_needed() argument
152 return !!(ddata->cfg.quirks & SYSC_QUIRK_OPT_CLKS_NEEDED); in sysc_opt_clks_needed()
155 static u32 sysc_read_revision(struct sysc *ddata) in sysc_read_revision() argument
157 int offset = ddata->offsets[SYSC_REVISION]; in sysc_read_revision()
162 return sysc_read(ddata, offset); in sysc_read_revision()
165 static u32 sysc_read_sysconfig(struct sysc *ddata) in sysc_read_sysconfig() argument
167 int offset = ddata->offsets[SYSC_SYSCONFIG]; in sysc_read_sysconfig()
172 return sysc_read(ddata, offset); in sysc_read_sysconfig()
175 static u32 sysc_read_sysstatus(struct sysc *ddata) in sysc_read_sysstatus() argument
177 int offset = ddata->offsets[SYSC_SYSSTATUS]; in sysc_read_sysstatus()
182 return sysc_read(ddata, offset); in sysc_read_sysstatus()
185 static int sysc_add_named_clock_from_child(struct sysc *ddata, in sysc_add_named_clock_from_child() argument
189 struct device_node *np = ddata->dev->of_node; in sysc_add_named_clock_from_child()
212 clock = devm_get_clk_from_child(ddata->dev, child, name); in sysc_add_named_clock_from_child()
226 cl->dev_id = dev_name(ddata->dev); in sysc_add_named_clock_from_child()
235 static int sysc_init_ext_opt_clock(struct sysc *ddata, const char *name) in sysc_init_ext_opt_clock() argument
240 if (ddata->nr_clocks < SYSC_OPTFCK0) in sysc_init_ext_opt_clock()
243 index = ddata->nr_clocks; in sysc_init_ext_opt_clock()
250 error = sysc_add_named_clock_from_child(ddata, name, optfck_name); in sysc_init_ext_opt_clock()
254 ddata->clock_roles[index] = optfck_name; in sysc_init_ext_opt_clock()
255 ddata->nr_clocks++; in sysc_init_ext_opt_clock()
260 static int sysc_get_one_clock(struct sysc *ddata, const char *name) in sysc_get_one_clock() argument
271 if (!ddata->clocks[i]) { in sysc_get_one_clock()
279 dev_err(ddata->dev, "clock %s not added\n", name); in sysc_get_one_clock()
283 ddata->clocks[index] = devm_clk_get(ddata->dev, name); in sysc_get_one_clock()
284 if (IS_ERR(ddata->clocks[index])) { in sysc_get_one_clock()
285 dev_err(ddata->dev, "clock get error for %s: %li\n", in sysc_get_one_clock()
286 name, PTR_ERR(ddata->clocks[index])); in sysc_get_one_clock()
288 return PTR_ERR(ddata->clocks[index]); in sysc_get_one_clock()
291 error = clk_prepare(ddata->clocks[index]); in sysc_get_one_clock()
293 dev_err(ddata->dev, "clock prepare error for %s: %i\n", in sysc_get_one_clock()
302 static int sysc_get_clocks(struct sysc *ddata) in sysc_get_clocks() argument
304 struct device_node *np = ddata->dev->of_node; in sysc_get_clocks()
309 ddata->clock_roles = devm_kcalloc(ddata->dev, in sysc_get_clocks()
311 sizeof(*ddata->clock_roles), in sysc_get_clocks()
313 if (!ddata->clock_roles) in sysc_get_clocks()
321 ddata->clock_roles[ddata->nr_clocks] = name; in sysc_get_clocks()
322 ddata->nr_clocks++; in sysc_get_clocks()
325 if (ddata->nr_clocks < 1) in sysc_get_clocks()
328 if ((ddata->cfg.quirks & SYSC_QUIRK_EXT_OPT_CLOCK)) { in sysc_get_clocks()
329 error = sysc_init_ext_opt_clock(ddata, NULL); in sysc_get_clocks()
334 if (ddata->nr_clocks > SYSC_MAX_CLOCKS) { in sysc_get_clocks()
335 dev_err(ddata->dev, "too many clocks for %pOF\n", np); in sysc_get_clocks()
341 dev_err(ddata->dev, "max one fck and ick for %pOF\n", np); in sysc_get_clocks()
346 ddata->clocks = devm_kcalloc(ddata->dev, in sysc_get_clocks()
347 ddata->nr_clocks, sizeof(*ddata->clocks), in sysc_get_clocks()
349 if (!ddata->clocks) in sysc_get_clocks()
353 const char *name = ddata->clock_roles[i]; in sysc_get_clocks()
358 error = sysc_get_one_clock(ddata, name); in sysc_get_clocks()
366 static int sysc_enable_main_clocks(struct sysc *ddata) in sysc_enable_main_clocks() argument
371 if (!ddata->clocks) in sysc_enable_main_clocks()
375 clock = ddata->clocks[i]; in sysc_enable_main_clocks()
390 clock = ddata->clocks[i]; in sysc_enable_main_clocks()
402 static void sysc_disable_main_clocks(struct sysc *ddata) in sysc_disable_main_clocks() argument
407 if (!ddata->clocks) in sysc_disable_main_clocks()
411 clock = ddata->clocks[i]; in sysc_disable_main_clocks()
419 static int sysc_enable_opt_clocks(struct sysc *ddata) in sysc_enable_opt_clocks() argument
424 if (!ddata->clocks) in sysc_enable_opt_clocks()
428 clock = ddata->clocks[i]; in sysc_enable_opt_clocks()
443 clock = ddata->clocks[i]; in sysc_enable_opt_clocks()
453 static void sysc_disable_opt_clocks(struct sysc *ddata) in sysc_disable_opt_clocks() argument
458 if (!ddata->clocks) in sysc_disable_opt_clocks()
462 clock = ddata->clocks[i]; in sysc_disable_opt_clocks()
472 static void sysc_clkdm_deny_idle(struct sysc *ddata) in sysc_clkdm_deny_idle() argument
476 if (ddata->legacy_mode) in sysc_clkdm_deny_idle()
479 pdata = dev_get_platdata(ddata->dev); in sysc_clkdm_deny_idle()
481 pdata->clkdm_deny_idle(ddata->dev, &ddata->cookie); in sysc_clkdm_deny_idle()
484 static void sysc_clkdm_allow_idle(struct sysc *ddata) in sysc_clkdm_allow_idle() argument
488 if (ddata->legacy_mode) in sysc_clkdm_allow_idle()
491 pdata = dev_get_platdata(ddata->dev); in sysc_clkdm_allow_idle()
493 pdata->clkdm_allow_idle(ddata->dev, &ddata->cookie); in sysc_clkdm_allow_idle()
502 static int sysc_init_resets(struct sysc *ddata) in sysc_init_resets() argument
504 ddata->rsts = in sysc_init_resets()
505 devm_reset_control_get_optional_shared(ddata->dev, "rstctrl"); in sysc_init_resets()
506 if (IS_ERR(ddata->rsts)) in sysc_init_resets()
507 return PTR_ERR(ddata->rsts); in sysc_init_resets()
521 static int sysc_parse_and_check_child_range(struct sysc *ddata) in sysc_parse_and_check_child_range() argument
523 struct device_node *np = ddata->dev->of_node; in sysc_parse_and_check_child_range()
530 dev_err(ddata->dev, "missing ranges for %pOF\n", np); in sysc_parse_and_check_child_range()
538 dev_err(ddata->dev, "incomplete ranges for %pOF\n", np); in sysc_parse_and_check_child_range()
552 dev_err(ddata->dev, "invalid ranges for %pOF\n", np); in sysc_parse_and_check_child_range()
558 ddata->module_pa = of_translate_address(np, ranges++); in sysc_parse_and_check_child_range()
559 ddata->module_size = be32_to_cpup(ranges); in sysc_parse_and_check_child_range()
566 static void sysc_init_stdout_path(struct sysc *ddata) in sysc_init_stdout_path() argument
597 static void sysc_check_quirk_stdout(struct sysc *ddata, in sysc_check_quirk_stdout() argument
600 sysc_init_stdout_path(ddata); in sysc_check_quirk_stdout()
604 ddata->cfg.quirks |= SYSC_QUIRK_NO_IDLE_ON_INIT | in sysc_check_quirk_stdout()
617 static void sysc_check_one_child(struct sysc *ddata, in sysc_check_one_child() argument
624 dev_warn(ddata->dev, "really a child ti,hwmods property?"); in sysc_check_one_child()
626 sysc_check_quirk_stdout(ddata, np); in sysc_check_one_child()
627 sysc_parse_dts_quirks(ddata, np, true); in sysc_check_one_child()
630 static void sysc_check_children(struct sysc *ddata) in sysc_check_children() argument
634 for_each_child_of_node(ddata->dev->of_node, child) in sysc_check_children()
635 sysc_check_one_child(ddata, child); in sysc_check_children()
644 static void sysc_check_quirk_16bit(struct sysc *ddata, struct resource *res) in sysc_check_quirk_16bit() argument
647 ddata->cfg.quirks |= SYSC_QUIRK_16BIT | SYSC_QUIRK_USE_CLOCKACT; in sysc_check_quirk_16bit()
655 static int sysc_parse_one(struct sysc *ddata, enum sysc_registers reg) in sysc_parse_one() argument
670 res = platform_get_resource_byname(to_platform_device(ddata->dev), in sysc_parse_one()
673 ddata->offsets[reg] = -ENODEV; in sysc_parse_one()
678 ddata->offsets[reg] = res->start - ddata->module_pa; in sysc_parse_one()
680 sysc_check_quirk_16bit(ddata, res); in sysc_parse_one()
685 static int sysc_parse_registers(struct sysc *ddata) in sysc_parse_registers() argument
690 error = sysc_parse_one(ddata, i); in sysc_parse_registers()
702 static int sysc_check_registers(struct sysc *ddata) in sysc_check_registers() argument
707 if (ddata->offsets[i] < 0) in sysc_check_registers()
710 if (ddata->offsets[i] > (ddata->module_size - 4)) { in sysc_check_registers()
711 dev_err(ddata->dev, "register outside module range"); in sysc_check_registers()
717 if (ddata->offsets[j] < 0) in sysc_check_registers()
720 if (ddata->offsets[i] == ddata->offsets[j]) in sysc_check_registers()
727 dev_err(ddata->dev, "overlapping registers: (%i/%i)", in sysc_check_registers()
747 static int sysc_ioremap(struct sysc *ddata) in sysc_ioremap() argument
751 if (ddata->offsets[SYSC_REVISION] < 0 && in sysc_ioremap()
752 ddata->offsets[SYSC_SYSCONFIG] < 0 && in sysc_ioremap()
753 ddata->offsets[SYSC_SYSSTATUS] < 0) { in sysc_ioremap()
754 size = ddata->module_size; in sysc_ioremap()
756 size = max3(ddata->offsets[SYSC_REVISION], in sysc_ioremap()
757 ddata->offsets[SYSC_SYSCONFIG], in sysc_ioremap()
758 ddata->offsets[SYSC_SYSSTATUS]); in sysc_ioremap()
763 if ((size + sizeof(u32)) > ddata->module_size) in sysc_ioremap()
764 size = ddata->module_size; in sysc_ioremap()
767 ddata->module_va = devm_ioremap(ddata->dev, in sysc_ioremap()
768 ddata->module_pa, in sysc_ioremap()
770 if (!ddata->module_va) in sysc_ioremap()
780 static int sysc_map_and_check_registers(struct sysc *ddata) in sysc_map_and_check_registers() argument
784 error = sysc_parse_and_check_child_range(ddata); in sysc_map_and_check_registers()
788 sysc_check_children(ddata); in sysc_map_and_check_registers()
790 error = sysc_parse_registers(ddata); in sysc_map_and_check_registers()
794 error = sysc_ioremap(ddata); in sysc_map_and_check_registers()
798 error = sysc_check_registers(ddata); in sysc_map_and_check_registers()
810 static int sysc_show_rev(char *bufp, struct sysc *ddata) in sysc_show_rev() argument
814 if (ddata->offsets[SYSC_REVISION] < 0) in sysc_show_rev()
817 len = sprintf(bufp, ":%08x", ddata->revision); in sysc_show_rev()
822 static int sysc_show_reg(struct sysc *ddata, in sysc_show_reg() argument
825 if (ddata->offsets[reg] < 0) in sysc_show_reg()
828 return sprintf(bufp, ":%x", ddata->offsets[reg]); in sysc_show_reg()
831 static int sysc_show_name(char *bufp, struct sysc *ddata) in sysc_show_name() argument
833 if (!ddata->name) in sysc_show_name()
836 return sprintf(bufp, ":%s", ddata->name); in sysc_show_name()
843 static void sysc_show_registers(struct sysc *ddata) in sysc_show_registers() argument
850 bufp += sysc_show_reg(ddata, bufp, i); in sysc_show_registers()
852 bufp += sysc_show_rev(bufp, ddata); in sysc_show_registers()
853 bufp += sysc_show_name(bufp, ddata); in sysc_show_registers()
855 dev_dbg(ddata->dev, "%llx:%x%s\n", in sysc_show_registers()
856 ddata->module_pa, ddata->module_size, in sysc_show_registers()
866 struct sysc *ddata; in sysc_enable_module() local
870 ddata = dev_get_drvdata(dev); in sysc_enable_module()
871 if (ddata->offsets[SYSC_SYSCONFIG] == -ENODEV) in sysc_enable_module()
874 regbits = ddata->cap->regbits; in sysc_enable_module()
875 reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]); in sysc_enable_module()
879 (ddata->cfg.quirks & SYSC_QUIRK_USE_CLOCKACT || in sysc_enable_module()
880 ddata->cfg.sysc_val & BIT(regbits->clkact_shift))) in sysc_enable_module()
884 idlemodes = ddata->cfg.sidlemodes; in sysc_enable_module()
888 if (ddata->cfg.quirks & (SYSC_QUIRK_SWSUP_SIDLE | in sysc_enable_module()
892 best_mode = fls(ddata->cfg.sidlemodes) - 1; in sysc_enable_module()
900 ddata->cfg.sysc_val & BIT(regbits->enwkup_shift)) in sysc_enable_module()
906 sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg); in sysc_enable_module()
910 idlemodes = ddata->cfg.midlemodes; in sysc_enable_module()
914 best_mode = fls(ddata->cfg.midlemodes) - 1; in sysc_enable_module()
922 sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg); in sysc_enable_module()
927 ddata->cfg.sysc_val & BIT(regbits->autoidle_shift)) { in sysc_enable_module()
929 sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg); in sysc_enable_module()
932 if (ddata->module_enable_quirk) in sysc_enable_module()
933 ddata->module_enable_quirk(ddata); in sysc_enable_module()
955 struct sysc *ddata; in sysc_disable_module() local
960 ddata = dev_get_drvdata(dev); in sysc_disable_module()
961 if (ddata->offsets[SYSC_SYSCONFIG] == -ENODEV) in sysc_disable_module()
964 if (ddata->module_disable_quirk) in sysc_disable_module()
965 ddata->module_disable_quirk(ddata); in sysc_disable_module()
967 regbits = ddata->cap->regbits; in sysc_disable_module()
968 reg = sysc_read(ddata, ddata->offsets[SYSC_SYSCONFIG]); in sysc_disable_module()
971 idlemodes = ddata->cfg.midlemodes; in sysc_disable_module()
983 sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg); in sysc_disable_module()
987 idlemodes = ddata->cfg.sidlemodes; in sysc_disable_module()
991 if (ddata->cfg.quirks & SYSC_QUIRK_SWSUP_SIDLE) { in sysc_disable_module()
1004 ddata->cfg.sysc_val & BIT(regbits->autoidle_shift)) in sysc_disable_module()
1006 sysc_write(ddata, ddata->offsets[SYSC_SYSCONFIG], reg); in sysc_disable_module()
1012 struct sysc *ddata) in sysc_runtime_suspend_legacy() argument
1017 pdata = dev_get_platdata(ddata->dev); in sysc_runtime_suspend_legacy()
1024 error = pdata->idle_module(dev, &ddata->cookie); in sysc_runtime_suspend_legacy()
1029 reset_control_assert(ddata->rsts); in sysc_runtime_suspend_legacy()
1035 struct sysc *ddata) in sysc_runtime_resume_legacy() argument
1040 reset_control_deassert(ddata->rsts); in sysc_runtime_resume_legacy()
1042 pdata = dev_get_platdata(ddata->dev); in sysc_runtime_resume_legacy()
1049 error = pdata->enable_module(dev, &ddata->cookie); in sysc_runtime_resume_legacy()
1059 struct sysc *ddata; in sysc_runtime_suspend() local
1062 ddata = dev_get_drvdata(dev); in sysc_runtime_suspend()
1064 if (!ddata->enabled) in sysc_runtime_suspend()
1067 sysc_clkdm_deny_idle(ddata); in sysc_runtime_suspend()
1069 if (ddata->legacy_mode) { in sysc_runtime_suspend()
1070 error = sysc_runtime_suspend_legacy(dev, ddata); in sysc_runtime_suspend()
1079 sysc_disable_main_clocks(ddata); in sysc_runtime_suspend()
1081 if (sysc_opt_clks_needed(ddata)) in sysc_runtime_suspend()
1082 sysc_disable_opt_clocks(ddata); in sysc_runtime_suspend()
1084 ddata->enabled = false; in sysc_runtime_suspend()
1087 reset_control_assert(ddata->rsts); in sysc_runtime_suspend()
1089 sysc_clkdm_allow_idle(ddata); in sysc_runtime_suspend()
1096 struct sysc *ddata; in sysc_runtime_resume() local
1099 ddata = dev_get_drvdata(dev); in sysc_runtime_resume()
1101 if (ddata->enabled) in sysc_runtime_resume()
1105 sysc_clkdm_deny_idle(ddata); in sysc_runtime_resume()
1107 reset_control_deassert(ddata->rsts); in sysc_runtime_resume()
1109 if (sysc_opt_clks_needed(ddata)) { in sysc_runtime_resume()
1110 error = sysc_enable_opt_clocks(ddata); in sysc_runtime_resume()
1115 error = sysc_enable_main_clocks(ddata); in sysc_runtime_resume()
1119 if (ddata->legacy_mode) { in sysc_runtime_resume()
1120 error = sysc_runtime_resume_legacy(dev, ddata); in sysc_runtime_resume()
1129 ddata->enabled = true; in sysc_runtime_resume()
1131 sysc_clkdm_allow_idle(ddata); in sysc_runtime_resume()
1136 sysc_disable_main_clocks(ddata); in sysc_runtime_resume()
1138 if (sysc_opt_clks_needed(ddata)) in sysc_runtime_resume()
1139 sysc_disable_opt_clocks(ddata); in sysc_runtime_resume()
1141 sysc_clkdm_allow_idle(ddata); in sysc_runtime_resume()
1148 struct sysc *ddata; in sysc_noirq_suspend() local
1150 ddata = dev_get_drvdata(dev); in sysc_noirq_suspend()
1152 if (ddata->cfg.quirks & SYSC_QUIRK_LEGACY_IDLE) in sysc_noirq_suspend()
1160 struct sysc *ddata; in sysc_noirq_resume() local
1162 ddata = dev_get_drvdata(dev); in sysc_noirq_resume()
1164 if (ddata->cfg.quirks & SYSC_QUIRK_LEGACY_IDLE) in sysc_noirq_resume()
1322 static void sysc_init_early_quirks(struct sysc *ddata) in sysc_init_early_quirks() argument
1333 if (q->base != ddata->module_pa) in sysc_init_early_quirks()
1337 q->rev_offset != ddata->offsets[SYSC_REVISION]) in sysc_init_early_quirks()
1341 q->sysc_offset != ddata->offsets[SYSC_SYSCONFIG]) in sysc_init_early_quirks()
1345 q->syss_offset != ddata->offsets[SYSC_SYSSTATUS]) in sysc_init_early_quirks()
1348 ddata->name = q->name; in sysc_init_early_quirks()
1349 ddata->cfg.quirks |= q->quirks; in sysc_init_early_quirks()
1354 static void sysc_init_revision_quirks(struct sysc *ddata) in sysc_init_revision_quirks() argument
1362 if (q->base && q->base != ddata->module_pa) in sysc_init_revision_quirks()
1366 q->rev_offset != ddata->offsets[SYSC_REVISION]) in sysc_init_revision_quirks()
1370 q->sysc_offset != ddata->offsets[SYSC_SYSCONFIG]) in sysc_init_revision_quirks()
1374 q->syss_offset != ddata->offsets[SYSC_SYSSTATUS]) in sysc_init_revision_quirks()
1377 if (q->revision == ddata->revision || in sysc_init_revision_quirks()
1379 (ddata->revision & q->revision_mask)) { in sysc_init_revision_quirks()
1380 ddata->name = q->name; in sysc_init_revision_quirks()
1381 ddata->cfg.quirks |= q->quirks; in sysc_init_revision_quirks()
1387 static void sysc_clk_enable_quirk_hdq1w(struct sysc *ddata) in sysc_clk_enable_quirk_hdq1w() argument
1392 val = sysc_read(ddata, offset); in sysc_clk_enable_quirk_hdq1w()
1394 sysc_write(ddata, offset, val); in sysc_clk_enable_quirk_hdq1w()
1398 static void sysc_clk_quirk_i2c(struct sysc *ddata, bool enable) in sysc_clk_quirk_i2c() argument
1404 if ((ddata->revision & 0xffffff00) == 0x001f0000) in sysc_clk_quirk_i2c()
1410 val = sysc_read(ddata, offset); in sysc_clk_quirk_i2c()
1415 sysc_write(ddata, offset, val); in sysc_clk_quirk_i2c()
1418 static void sysc_clk_enable_quirk_i2c(struct sysc *ddata) in sysc_clk_enable_quirk_i2c() argument
1420 sysc_clk_quirk_i2c(ddata, true); in sysc_clk_enable_quirk_i2c()
1423 static void sysc_clk_disable_quirk_i2c(struct sysc *ddata) in sysc_clk_disable_quirk_i2c() argument
1425 sysc_clk_quirk_i2c(ddata, false); in sysc_clk_disable_quirk_i2c()
1429 static void sysc_module_enable_quirk_sgx(struct sysc *ddata) in sysc_module_enable_quirk_sgx() argument
1434 sysc_write(ddata, offset, val); in sysc_module_enable_quirk_sgx()
1438 static void sysc_reset_done_quirk_wdt(struct sysc *ddata) in sysc_reset_done_quirk_wdt() argument
1446 sysc_write(ddata, spr, 0xaaaa); in sysc_reset_done_quirk_wdt()
1447 error = readl_poll_timeout(ddata->module_va + wps, val, in sysc_reset_done_quirk_wdt()
1451 dev_warn(ddata->dev, "wdt disable step1 failed\n"); in sysc_reset_done_quirk_wdt()
1453 sysc_write(ddata, spr, 0x5555); in sysc_reset_done_quirk_wdt()
1454 error = readl_poll_timeout(ddata->module_va + wps, val, in sysc_reset_done_quirk_wdt()
1458 dev_warn(ddata->dev, "wdt disable step2 failed\n"); in sysc_reset_done_quirk_wdt()
1461 static void sysc_init_module_quirks(struct sysc *ddata) in sysc_init_module_quirks() argument
1463 if (ddata->legacy_mode || !ddata->name) in sysc_init_module_quirks()
1466 if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_HDQ1W) { in sysc_init_module_quirks()
1467 ddata->clk_enable_quirk = sysc_clk_enable_quirk_hdq1w; in sysc_init_module_quirks()
1472 if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_I2C) { in sysc_init_module_quirks()
1473 ddata->clk_enable_quirk = sysc_clk_enable_quirk_i2c; in sysc_init_module_quirks()
1474 ddata->clk_disable_quirk = sysc_clk_disable_quirk_i2c; in sysc_init_module_quirks()
1479 if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_SGX) in sysc_init_module_quirks()
1480 ddata->module_enable_quirk = sysc_module_enable_quirk_sgx; in sysc_init_module_quirks()
1482 if (ddata->cfg.quirks & SYSC_MODULE_QUIRK_WDT) { in sysc_init_module_quirks()
1483 ddata->reset_done_quirk = sysc_reset_done_quirk_wdt; in sysc_init_module_quirks()
1484 ddata->module_disable_quirk = sysc_reset_done_quirk_wdt; in sysc_init_module_quirks()
1488 static int sysc_clockdomain_init(struct sysc *ddata) in sysc_clockdomain_init() argument
1490 struct ti_sysc_platform_data *pdata = dev_get_platdata(ddata->dev); in sysc_clockdomain_init()
1497 switch (ddata->nr_clocks) { in sysc_clockdomain_init()
1499 ick = ddata->clocks[SYSC_ICK]; in sysc_clockdomain_init()
1502 fck = ddata->clocks[SYSC_FCK]; in sysc_clockdomain_init()
1508 error = pdata->init_clockdomain(ddata->dev, fck, ick, &ddata->cookie); in sysc_clockdomain_init()
1520 static int sysc_legacy_init(struct sysc *ddata) in sysc_legacy_init() argument
1522 struct ti_sysc_platform_data *pdata = dev_get_platdata(ddata->dev); in sysc_legacy_init()
1528 error = pdata->init_module(ddata->dev, ddata->mdata, &ddata->cookie); in sysc_legacy_init()
1548 static int sysc_rstctrl_reset_deassert(struct sysc *ddata, bool reset) in sysc_rstctrl_reset_deassert() argument
1552 if (!ddata->rsts) in sysc_rstctrl_reset_deassert()
1556 error = reset_control_assert(ddata->rsts); in sysc_rstctrl_reset_deassert()
1561 reset_control_deassert(ddata->rsts); in sysc_rstctrl_reset_deassert()
1570 static int sysc_reset(struct sysc *ddata) in sysc_reset() argument
1575 sysc_offset = ddata->offsets[SYSC_SYSCONFIG]; in sysc_reset()
1576 syss_offset = ddata->offsets[SYSC_SYSSTATUS]; in sysc_reset()
1578 if (ddata->legacy_mode || sysc_offset < 0 || in sysc_reset()
1579 ddata->cap->regbits->srst_shift < 0 || in sysc_reset()
1580 ddata->cfg.quirks & SYSC_QUIRK_NO_RESET_ON_INIT) in sysc_reset()
1583 sysc_mask = BIT(ddata->cap->regbits->srst_shift); in sysc_reset()
1585 if (ddata->cfg.quirks & SYSS_QUIRK_RESETDONE_INVERTED) in sysc_reset()
1588 syss_done = ddata->cfg.syss_mask; in sysc_reset()
1590 if (ddata->clk_disable_quirk) in sysc_reset()
1591 ddata->clk_disable_quirk(ddata); in sysc_reset()
1593 sysc_val = sysc_read_sysconfig(ddata); in sysc_reset()
1595 sysc_write(ddata, sysc_offset, sysc_val); in sysc_reset()
1597 if (ddata->clk_enable_quirk) in sysc_reset()
1598 ddata->clk_enable_quirk(ddata); in sysc_reset()
1602 error = readx_poll_timeout(sysc_read_sysstatus, ddata, rstval, in sysc_reset()
1603 (rstval & ddata->cfg.syss_mask) == in sysc_reset()
1607 } else if (ddata->cfg.quirks & SYSC_QUIRK_RESET_STATUS) { in sysc_reset()
1608 error = readx_poll_timeout(sysc_read_sysconfig, ddata, rstval, in sysc_reset()
1613 if (ddata->reset_done_quirk) in sysc_reset()
1614 ddata->reset_done_quirk(ddata); in sysc_reset()
1625 static int sysc_init_module(struct sysc *ddata) in sysc_init_module() argument
1630 error = sysc_rstctrl_reset_deassert(ddata, false); in sysc_init_module()
1634 if (ddata->cfg.quirks & in sysc_init_module()
1638 error = sysc_clockdomain_init(ddata); in sysc_init_module()
1642 sysc_clkdm_deny_idle(ddata); in sysc_init_module()
1648 error = sysc_enable_opt_clocks(ddata); in sysc_init_module()
1652 error = sysc_enable_main_clocks(ddata); in sysc_init_module()
1656 if (!(ddata->cfg.quirks & SYSC_QUIRK_NO_RESET_ON_INIT)) { in sysc_init_module()
1657 error = sysc_rstctrl_reset_deassert(ddata, true); in sysc_init_module()
1662 ddata->revision = sysc_read_revision(ddata); in sysc_init_module()
1663 sysc_init_revision_quirks(ddata); in sysc_init_module()
1664 sysc_init_module_quirks(ddata); in sysc_init_module()
1666 if (ddata->legacy_mode) { in sysc_init_module()
1667 error = sysc_legacy_init(ddata); in sysc_init_module()
1672 if (!ddata->legacy_mode) { in sysc_init_module()
1673 error = sysc_enable_module(ddata->dev); in sysc_init_module()
1678 error = sysc_reset(ddata); in sysc_init_module()
1680 dev_err(ddata->dev, "Reset failed with %d\n", error); in sysc_init_module()
1682 if (!ddata->legacy_mode && manage_clocks) in sysc_init_module()
1683 sysc_disable_module(ddata->dev); in sysc_init_module()
1687 sysc_disable_main_clocks(ddata); in sysc_init_module()
1691 sysc_disable_opt_clocks(ddata); in sysc_init_module()
1692 sysc_clkdm_allow_idle(ddata); in sysc_init_module()
1698 static int sysc_init_sysc_mask(struct sysc *ddata) in sysc_init_sysc_mask() argument
1700 struct device_node *np = ddata->dev->of_node; in sysc_init_sysc_mask()
1708 ddata->cfg.sysc_val = val & ddata->cap->sysc_mask; in sysc_init_sysc_mask()
1713 static int sysc_init_idlemode(struct sysc *ddata, u8 *idlemodes, in sysc_init_idlemode() argument
1716 struct device_node *np = ddata->dev->of_node; in sysc_init_idlemode()
1723 dev_err(ddata->dev, "invalid idlemode: %i\n", val); in sysc_init_idlemode()
1732 static int sysc_init_idlemodes(struct sysc *ddata) in sysc_init_idlemodes() argument
1736 error = sysc_init_idlemode(ddata, &ddata->cfg.midlemodes, in sysc_init_idlemodes()
1741 error = sysc_init_idlemode(ddata, &ddata->cfg.sidlemodes, in sysc_init_idlemodes()
1756 static int sysc_init_syss_mask(struct sysc *ddata) in sysc_init_syss_mask() argument
1758 struct device_node *np = ddata->dev->of_node; in sysc_init_syss_mask()
1764 if ((ddata->cap->type == TI_SYSC_OMAP4 || in sysc_init_syss_mask()
1765 ddata->cap->type == TI_SYSC_OMAP4_TIMER) && in sysc_init_syss_mask()
1766 (ddata->cfg.sysc_val & SYSC_OMAP4_SOFTRESET)) in sysc_init_syss_mask()
1767 ddata->cfg.quirks |= SYSC_QUIRK_RESET_STATUS; in sysc_init_syss_mask()
1772 if (!(val & 1) && (ddata->cfg.sysc_val & SYSC_OMAP4_SOFTRESET)) in sysc_init_syss_mask()
1773 ddata->cfg.quirks |= SYSC_QUIRK_RESET_STATUS; in sysc_init_syss_mask()
1775 ddata->cfg.syss_mask = val; in sysc_init_syss_mask()
1784 static int sysc_child_add_named_clock(struct sysc *ddata, in sysc_child_add_named_clock() argument
1802 clk = clk_get(ddata->dev, name); in sysc_child_add_named_clock()
1815 static int sysc_child_add_clocks(struct sysc *ddata, in sysc_child_add_clocks() argument
1820 for (i = 0; i < ddata->nr_clocks; i++) { in sysc_child_add_clocks()
1821 error = sysc_child_add_named_clock(ddata, in sysc_child_add_clocks()
1823 ddata->clock_roles[i]); in sysc_child_add_clocks()
1825 dev_err(ddata->dev, "could not add child clock %s: %i\n", in sysc_child_add_clocks()
1826 ddata->clock_roles[i], error); in sysc_child_add_clocks()
1850 struct sysc *ddata; in sysc_child_runtime_suspend() local
1853 ddata = sysc_child_to_parent(dev); in sysc_child_runtime_suspend()
1859 if (!ddata->enabled) in sysc_child_runtime_suspend()
1862 return sysc_runtime_suspend(ddata->dev); in sysc_child_runtime_suspend()
1867 struct sysc *ddata; in sysc_child_runtime_resume() local
1870 ddata = sysc_child_to_parent(dev); in sysc_child_runtime_resume()
1872 if (!ddata->enabled) { in sysc_child_runtime_resume()
1873 error = sysc_runtime_resume(ddata->dev); in sysc_child_runtime_resume()
1875 dev_err(ddata->dev, in sysc_child_runtime_resume()
1885 struct sysc *ddata; in sysc_child_suspend_noirq() local
1888 ddata = sysc_child_to_parent(dev); in sysc_child_suspend_noirq()
1890 dev_dbg(ddata->dev, "%s %s\n", __func__, in sysc_child_suspend_noirq()
1891 ddata->name ? ddata->name : ""); in sysc_child_suspend_noirq()
1910 error = sysc_runtime_suspend(ddata->dev); in sysc_child_suspend_noirq()
1918 ddata->child_needs_resume = true; in sysc_child_suspend_noirq()
1926 struct sysc *ddata; in sysc_child_resume_noirq() local
1929 ddata = sysc_child_to_parent(dev); in sysc_child_resume_noirq()
1931 dev_dbg(ddata->dev, "%s %s\n", __func__, in sysc_child_resume_noirq()
1932 ddata->name ? ddata->name : ""); in sysc_child_resume_noirq()
1934 if (ddata->child_needs_resume) { in sysc_child_resume_noirq()
1935 ddata->child_needs_resume = false; in sysc_child_resume_noirq()
1937 error = sysc_runtime_resume(ddata->dev); in sysc_child_resume_noirq()
1939 dev_err(ddata->dev, in sysc_child_resume_noirq()
1945 dev_err(ddata->dev, in sysc_child_resume_noirq()
1978 static void sysc_legacy_idle_quirk(struct sysc *ddata, struct device *child) in sysc_legacy_idle_quirk() argument
1980 if (ddata->cfg.quirks & SYSC_QUIRK_LEGACY_IDLE) in sysc_legacy_idle_quirk()
1988 struct sysc *ddata; in sysc_notifier_call() local
1991 ddata = sysc_child_to_parent(dev); in sysc_notifier_call()
1992 if (!ddata) in sysc_notifier_call()
1997 error = sysc_child_add_clocks(ddata, dev); in sysc_notifier_call()
2000 sysc_legacy_idle_quirk(ddata, dev); in sysc_notifier_call()
2028 static void sysc_parse_dts_quirks(struct sysc *ddata, struct device_node *np, in sysc_parse_dts_quirks() argument
2041 ddata->cfg.quirks |= sysc_dts_quirks[i].mask; in sysc_parse_dts_quirks()
2043 dev_warn(ddata->dev, in sysc_parse_dts_quirks()
2050 static int sysc_init_dts_quirks(struct sysc *ddata) in sysc_init_dts_quirks() argument
2052 struct device_node *np = ddata->dev->of_node; in sysc_init_dts_quirks()
2056 ddata->legacy_mode = of_get_property(np, "ti,hwmods", NULL); in sysc_init_dts_quirks()
2058 sysc_parse_dts_quirks(ddata, np, false); in sysc_init_dts_quirks()
2062 dev_warn(ddata->dev, "bad ti,sysc-delay-us: %i\n", in sysc_init_dts_quirks()
2066 ddata->cfg.srst_udelay = (u8)val; in sysc_init_dts_quirks()
2072 static void sysc_unprepare(struct sysc *ddata) in sysc_unprepare() argument
2076 if (!ddata->clocks) in sysc_unprepare()
2080 if (!IS_ERR_OR_NULL(ddata->clocks[i])) in sysc_unprepare()
2081 clk_unprepare(ddata->clocks[i]); in sysc_unprepare()
2322 static int sysc_init_pdata(struct sysc *ddata) in sysc_init_pdata() argument
2324 struct ti_sysc_platform_data *pdata = dev_get_platdata(ddata->dev); in sysc_init_pdata()
2330 mdata = devm_kzalloc(ddata->dev, sizeof(*mdata), GFP_KERNEL); in sysc_init_pdata()
2334 if (ddata->legacy_mode) { in sysc_init_pdata()
2335 mdata->name = ddata->legacy_mode; in sysc_init_pdata()
2336 mdata->module_pa = ddata->module_pa; in sysc_init_pdata()
2337 mdata->module_size = ddata->module_size; in sysc_init_pdata()
2338 mdata->offsets = ddata->offsets; in sysc_init_pdata()
2340 mdata->cap = ddata->cap; in sysc_init_pdata()
2341 mdata->cfg = &ddata->cfg; in sysc_init_pdata()
2344 ddata->mdata = mdata; in sysc_init_pdata()
2349 static int sysc_init_match(struct sysc *ddata) in sysc_init_match() argument
2353 cap = of_device_get_match_data(ddata->dev); in sysc_init_match()
2357 ddata->cap = cap; in sysc_init_match()
2358 if (ddata->cap) in sysc_init_match()
2359 ddata->cfg.quirks |= ddata->cap->mod_quirks; in sysc_init_match()
2366 struct sysc *ddata; in ti_sysc_idle() local
2368 ddata = container_of(work, struct sysc, idle_work.work); in ti_sysc_idle()
2376 if (ddata->cfg.quirks & (SYSC_QUIRK_NO_IDLE | in ti_sysc_idle()
2378 sysc_disable_main_clocks(ddata); in ti_sysc_idle()
2379 sysc_disable_opt_clocks(ddata); in ti_sysc_idle()
2380 sysc_clkdm_allow_idle(ddata); in ti_sysc_idle()
2384 if (ddata->cfg.quirks & SYSC_QUIRK_NO_IDLE) in ti_sysc_idle()
2391 if (pm_runtime_active(ddata->dev)) in ti_sysc_idle()
2392 pm_runtime_put_sync(ddata->dev); in ti_sysc_idle()
2403 struct sysc *ddata; in sysc_probe() local
2406 ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL); in sysc_probe()
2407 if (!ddata) in sysc_probe()
2410 ddata->dev = &pdev->dev; in sysc_probe()
2411 platform_set_drvdata(pdev, ddata); in sysc_probe()
2413 error = sysc_init_match(ddata); in sysc_probe()
2417 error = sysc_init_dts_quirks(ddata); in sysc_probe()
2421 error = sysc_map_and_check_registers(ddata); in sysc_probe()
2425 error = sysc_init_sysc_mask(ddata); in sysc_probe()
2429 error = sysc_init_idlemodes(ddata); in sysc_probe()
2433 error = sysc_init_syss_mask(ddata); in sysc_probe()
2437 error = sysc_init_pdata(ddata); in sysc_probe()
2441 sysc_init_early_quirks(ddata); in sysc_probe()
2443 error = sysc_get_clocks(ddata); in sysc_probe()
2447 error = sysc_init_resets(ddata); in sysc_probe()
2451 error = sysc_init_module(ddata); in sysc_probe()
2455 pm_runtime_enable(ddata->dev); in sysc_probe()
2456 error = pm_runtime_get_sync(ddata->dev); in sysc_probe()
2458 pm_runtime_put_noidle(ddata->dev); in sysc_probe()
2459 pm_runtime_disable(ddata->dev); in sysc_probe()
2464 if (ddata->rsts) in sysc_probe()
2465 reset_control_assert(ddata->rsts); in sysc_probe()
2467 sysc_show_registers(ddata); in sysc_probe()
2469 ddata->dev->type = &sysc_device_type; in sysc_probe()
2470 error = of_platform_populate(ddata->dev->of_node, sysc_match_table, in sysc_probe()
2472 ddata->dev); in sysc_probe()
2476 INIT_DELAYED_WORK(&ddata->idle_work, ti_sysc_idle); in sysc_probe()
2479 if (ddata->cfg.quirks & (SYSC_QUIRK_NO_IDLE | in sysc_probe()
2482 schedule_delayed_work(&ddata->idle_work, 3000); in sysc_probe()
2493 sysc_unprepare(ddata); in sysc_probe()
2500 struct sysc *ddata = platform_get_drvdata(pdev); in sysc_remove() local
2503 cancel_delayed_work_sync(&ddata->idle_work); in sysc_remove()
2505 error = pm_runtime_get_sync(ddata->dev); in sysc_remove()
2507 pm_runtime_put_noidle(ddata->dev); in sysc_remove()
2508 pm_runtime_disable(ddata->dev); in sysc_remove()
2516 reset_control_assert(ddata->rsts); in sysc_remove()
2519 sysc_unprepare(ddata); in sysc_remove()