2 * Copyright (c) 2015, The Linux Foundation. All rights reserved.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 and
6 * only version 2 as published by the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
14 #include <linux/bitops.h>
15 #include <linux/delay.h>
16 #include <linux/err.h>
17 #include <linux/jiffies.h>
18 #include <linux/kernel.h>
19 #include <linux/pm_domain.h>
20 #include <linux/regmap.h>
21 #include <linux/slab.h>
24 #define PWR_ON_MASK BIT(31)
25 #define EN_REST_WAIT_MASK GENMASK_ULL(23, 20)
26 #define EN_FEW_WAIT_MASK GENMASK_ULL(19, 16)
27 #define CLK_DIS_WAIT_MASK GENMASK_ULL(15, 12)
28 #define SW_OVERRIDE_MASK BIT(2)
29 #define HW_CONTROL_MASK BIT(1)
30 #define SW_COLLAPSE_MASK BIT(0)
32 /* Wait 2^n CXO cycles between all states. Here, n=2 (4 cycles). */
33 #define EN_REST_WAIT_VAL (0x2 << 20)
34 #define EN_FEW_WAIT_VAL (0x8 << 16)
35 #define CLK_DIS_WAIT_VAL (0x2 << 12)
37 #define TIMEOUT_US 100
39 #define domain_to_gdsc(domain) container_of(domain, struct gdsc, pd)
41 static int gdsc_is_enabled(struct gdsc
*sc
)
46 ret
= regmap_read(sc
->regmap
, sc
->gdscr
, &val
);
50 return !!(val
& PWR_ON_MASK
);
53 static int gdsc_toggle_logic(struct gdsc
*sc
, bool en
)
56 u32 val
= en
? 0 : SW_COLLAPSE_MASK
;
57 u32 check
= en
? PWR_ON_MASK
: 0;
58 unsigned long timeout
;
60 ret
= regmap_update_bits(sc
->regmap
, sc
->gdscr
, SW_COLLAPSE_MASK
, val
);
64 timeout
= jiffies
+ usecs_to_jiffies(TIMEOUT_US
);
66 ret
= regmap_read(sc
->regmap
, sc
->gdscr
, &val
);
70 if ((val
& PWR_ON_MASK
) == check
)
72 } while (time_before(jiffies
, timeout
));
74 ret
= regmap_read(sc
->regmap
, sc
->gdscr
, &val
);
78 if ((val
& PWR_ON_MASK
) == check
)
84 static int gdsc_enable(struct generic_pm_domain
*domain
)
86 struct gdsc
*sc
= domain_to_gdsc(domain
);
89 ret
= gdsc_toggle_logic(sc
, true);
93 * If clocks to this power domain were already on, they will take an
94 * additional 4 clock cycles to re-enable after the power domain is
95 * enabled. Delay to account for this. A delay is also needed to ensure
96 * clocks are not enabled within 400ns of enabling power to the
104 static int gdsc_disable(struct generic_pm_domain
*domain
)
106 struct gdsc
*sc
= domain_to_gdsc(domain
);
108 return gdsc_toggle_logic(sc
, false);
111 static int gdsc_init(struct gdsc
*sc
)
117 * Disable HW trigger: collapse/restore occur based on registers writes.
118 * Disable SW override: Use hardware state-machine for sequencing.
119 * Configure wait time between states.
121 mask
= HW_CONTROL_MASK
| SW_OVERRIDE_MASK
|
122 EN_REST_WAIT_MASK
| EN_FEW_WAIT_MASK
| CLK_DIS_WAIT_MASK
;
123 val
= EN_REST_WAIT_VAL
| EN_FEW_WAIT_VAL
| CLK_DIS_WAIT_VAL
;
124 ret
= regmap_update_bits(sc
->regmap
, sc
->gdscr
, mask
, val
);
128 on
= gdsc_is_enabled(sc
);
132 sc
->pd
.power_off
= gdsc_disable
;
133 sc
->pd
.power_on
= gdsc_enable
;
134 pm_genpd_init(&sc
->pd
, NULL
, !on
);
139 int gdsc_register(struct device
*dev
, struct gdsc
**scs
, size_t num
,
140 struct regmap
*regmap
)
143 struct genpd_onecell_data
*data
;
145 data
= devm_kzalloc(dev
, sizeof(*data
), GFP_KERNEL
);
149 data
->domains
= devm_kcalloc(dev
, num
, sizeof(*data
->domains
),
154 data
->num_domains
= num
;
155 for (i
= 0; i
< num
; i
++) {
158 scs
[i
]->regmap
= regmap
;
159 ret
= gdsc_init(scs
[i
]);
162 data
->domains
[i
] = &scs
[i
]->pd
;
165 return of_genpd_add_provider_onecell(dev
->of_node
, data
);
168 void gdsc_unregister(struct device
*dev
)
170 of_genpd_del_provider(dev
->of_node
);
This page took 0.037722 seconds and 5 git commands to generate.