.. | .. |
---|
6 | 6 | #include <linux/of.h> |
---|
7 | 7 | #include <linux/platform_device.h> |
---|
8 | 8 | #include <linux/regmap.h> |
---|
9 | | -#include <uapi/linux/uleds.h> |
---|
10 | 9 | |
---|
11 | 10 | /* PMIC global control register definition */ |
---|
12 | 11 | #define SC27XX_MODULE_EN0 0xc08 |
---|
.. | .. |
---|
32 | 31 | #define SC27XX_DUTY_MASK GENMASK(15, 0) |
---|
33 | 32 | #define SC27XX_MOD_MASK GENMASK(7, 0) |
---|
34 | 33 | |
---|
| 34 | +#define SC27XX_CURVE_SHIFT 8 |
---|
| 35 | +#define SC27XX_CURVE_L_MASK GENMASK(7, 0) |
---|
| 36 | +#define SC27XX_CURVE_H_MASK GENMASK(15, 8) |
---|
| 37 | + |
---|
35 | 38 | #define SC27XX_LEDS_OFFSET 0x10 |
---|
36 | 39 | #define SC27XX_LEDS_MAX 3 |
---|
| 40 | +#define SC27XX_LEDS_PATTERN_CNT 4 |
---|
| 41 | +/* Stage duration step, in milliseconds */ |
---|
| 42 | +#define SC27XX_LEDS_STEP 125 |
---|
| 43 | +/* Minimum and maximum duration, in milliseconds */ |
---|
| 44 | +#define SC27XX_DELTA_T_MIN SC27XX_LEDS_STEP |
---|
| 45 | +#define SC27XX_DELTA_T_MAX (SC27XX_LEDS_STEP * 255) |
---|
37 | 46 | |
---|
38 | 47 | struct sc27xx_led { |
---|
39 | | - char name[LED_MAX_NAME_SIZE]; |
---|
| 48 | + struct fwnode_handle *fwnode; |
---|
40 | 49 | struct led_classdev ldev; |
---|
41 | 50 | struct sc27xx_led_priv *priv; |
---|
42 | 51 | u8 line; |
---|
.. | .. |
---|
122 | 131 | return err; |
---|
123 | 132 | } |
---|
124 | 133 | |
---|
| 134 | +static void sc27xx_led_clamp_align_delta_t(u32 *delta_t) |
---|
| 135 | +{ |
---|
| 136 | + u32 v, offset, t = *delta_t; |
---|
| 137 | + |
---|
| 138 | + v = t + SC27XX_LEDS_STEP / 2; |
---|
| 139 | + v = clamp_t(u32, v, SC27XX_DELTA_T_MIN, SC27XX_DELTA_T_MAX); |
---|
| 140 | + offset = v - SC27XX_DELTA_T_MIN; |
---|
| 141 | + offset = SC27XX_LEDS_STEP * (offset / SC27XX_LEDS_STEP); |
---|
| 142 | + |
---|
| 143 | + *delta_t = SC27XX_DELTA_T_MIN + offset; |
---|
| 144 | +} |
---|
| 145 | + |
---|
| 146 | +static int sc27xx_led_pattern_clear(struct led_classdev *ldev) |
---|
| 147 | +{ |
---|
| 148 | + struct sc27xx_led *leds = to_sc27xx_led(ldev); |
---|
| 149 | + struct regmap *regmap = leds->priv->regmap; |
---|
| 150 | + u32 base = sc27xx_led_get_offset(leds); |
---|
| 151 | + u32 ctrl_base = leds->priv->base + SC27XX_LEDS_CTRL; |
---|
| 152 | + u8 ctrl_shift = SC27XX_CTRL_SHIFT * leds->line; |
---|
| 153 | + int err; |
---|
| 154 | + |
---|
| 155 | + mutex_lock(&leds->priv->lock); |
---|
| 156 | + |
---|
| 157 | + /* Reset the rise, high, fall and low time to zero. */ |
---|
| 158 | + regmap_write(regmap, base + SC27XX_LEDS_CURVE0, 0); |
---|
| 159 | + regmap_write(regmap, base + SC27XX_LEDS_CURVE1, 0); |
---|
| 160 | + |
---|
| 161 | + err = regmap_update_bits(regmap, ctrl_base, |
---|
| 162 | + (SC27XX_LED_RUN | SC27XX_LED_TYPE) << ctrl_shift, 0); |
---|
| 163 | + |
---|
| 164 | + ldev->brightness = LED_OFF; |
---|
| 165 | + |
---|
| 166 | + mutex_unlock(&leds->priv->lock); |
---|
| 167 | + |
---|
| 168 | + return err; |
---|
| 169 | +} |
---|
| 170 | + |
---|
| 171 | +static int sc27xx_led_pattern_set(struct led_classdev *ldev, |
---|
| 172 | + struct led_pattern *pattern, |
---|
| 173 | + u32 len, int repeat) |
---|
| 174 | +{ |
---|
| 175 | + struct sc27xx_led *leds = to_sc27xx_led(ldev); |
---|
| 176 | + u32 base = sc27xx_led_get_offset(leds); |
---|
| 177 | + u32 ctrl_base = leds->priv->base + SC27XX_LEDS_CTRL; |
---|
| 178 | + u8 ctrl_shift = SC27XX_CTRL_SHIFT * leds->line; |
---|
| 179 | + struct regmap *regmap = leds->priv->regmap; |
---|
| 180 | + int err; |
---|
| 181 | + |
---|
| 182 | + /* |
---|
| 183 | + * Must contain 4 tuples to configure the rise time, high time, fall |
---|
| 184 | + * time and low time to enable the breathing mode. |
---|
| 185 | + */ |
---|
| 186 | + if (len != SC27XX_LEDS_PATTERN_CNT) |
---|
| 187 | + return -EINVAL; |
---|
| 188 | + |
---|
| 189 | + mutex_lock(&leds->priv->lock); |
---|
| 190 | + |
---|
| 191 | + sc27xx_led_clamp_align_delta_t(&pattern[0].delta_t); |
---|
| 192 | + err = regmap_update_bits(regmap, base + SC27XX_LEDS_CURVE0, |
---|
| 193 | + SC27XX_CURVE_L_MASK, |
---|
| 194 | + pattern[0].delta_t / SC27XX_LEDS_STEP); |
---|
| 195 | + if (err) |
---|
| 196 | + goto out; |
---|
| 197 | + |
---|
| 198 | + sc27xx_led_clamp_align_delta_t(&pattern[1].delta_t); |
---|
| 199 | + err = regmap_update_bits(regmap, base + SC27XX_LEDS_CURVE1, |
---|
| 200 | + SC27XX_CURVE_L_MASK, |
---|
| 201 | + pattern[1].delta_t / SC27XX_LEDS_STEP); |
---|
| 202 | + if (err) |
---|
| 203 | + goto out; |
---|
| 204 | + |
---|
| 205 | + sc27xx_led_clamp_align_delta_t(&pattern[2].delta_t); |
---|
| 206 | + err = regmap_update_bits(regmap, base + SC27XX_LEDS_CURVE0, |
---|
| 207 | + SC27XX_CURVE_H_MASK, |
---|
| 208 | + (pattern[2].delta_t / SC27XX_LEDS_STEP) << |
---|
| 209 | + SC27XX_CURVE_SHIFT); |
---|
| 210 | + if (err) |
---|
| 211 | + goto out; |
---|
| 212 | + |
---|
| 213 | + sc27xx_led_clamp_align_delta_t(&pattern[3].delta_t); |
---|
| 214 | + err = regmap_update_bits(regmap, base + SC27XX_LEDS_CURVE1, |
---|
| 215 | + SC27XX_CURVE_H_MASK, |
---|
| 216 | + (pattern[3].delta_t / SC27XX_LEDS_STEP) << |
---|
| 217 | + SC27XX_CURVE_SHIFT); |
---|
| 218 | + if (err) |
---|
| 219 | + goto out; |
---|
| 220 | + |
---|
| 221 | + err = regmap_update_bits(regmap, base + SC27XX_LEDS_DUTY, |
---|
| 222 | + SC27XX_DUTY_MASK, |
---|
| 223 | + (pattern[1].brightness << SC27XX_DUTY_SHIFT) | |
---|
| 224 | + SC27XX_MOD_MASK); |
---|
| 225 | + if (err) |
---|
| 226 | + goto out; |
---|
| 227 | + |
---|
| 228 | + /* Enable the LED breathing mode */ |
---|
| 229 | + err = regmap_update_bits(regmap, ctrl_base, |
---|
| 230 | + SC27XX_LED_RUN << ctrl_shift, |
---|
| 231 | + SC27XX_LED_RUN << ctrl_shift); |
---|
| 232 | + if (!err) |
---|
| 233 | + ldev->brightness = pattern[1].brightness; |
---|
| 234 | + |
---|
| 235 | +out: |
---|
| 236 | + mutex_unlock(&leds->priv->lock); |
---|
| 237 | + |
---|
| 238 | + return err; |
---|
| 239 | +} |
---|
| 240 | + |
---|
125 | 241 | static int sc27xx_led_register(struct device *dev, struct sc27xx_led_priv *priv) |
---|
126 | 242 | { |
---|
127 | 243 | int i, err; |
---|
.. | .. |
---|
132 | 248 | |
---|
133 | 249 | for (i = 0; i < SC27XX_LEDS_MAX; i++) { |
---|
134 | 250 | struct sc27xx_led *led = &priv->leds[i]; |
---|
| 251 | + struct led_init_data init_data = {}; |
---|
135 | 252 | |
---|
136 | 253 | if (!led->active) |
---|
137 | 254 | continue; |
---|
138 | 255 | |
---|
139 | 256 | led->line = i; |
---|
140 | 257 | led->priv = priv; |
---|
141 | | - led->ldev.name = led->name; |
---|
142 | 258 | led->ldev.brightness_set_blocking = sc27xx_led_set; |
---|
| 259 | + led->ldev.pattern_set = sc27xx_led_pattern_set; |
---|
| 260 | + led->ldev.pattern_clear = sc27xx_led_pattern_clear; |
---|
| 261 | + led->ldev.default_trigger = "pattern"; |
---|
143 | 262 | |
---|
144 | | - err = devm_led_classdev_register(dev, &led->ldev); |
---|
| 263 | + init_data.fwnode = led->fwnode; |
---|
| 264 | + init_data.devicename = "sc27xx"; |
---|
| 265 | + init_data.default_label = ":"; |
---|
| 266 | + |
---|
| 267 | + err = devm_led_classdev_register_ext(dev, &led->ldev, |
---|
| 268 | + &init_data); |
---|
145 | 269 | if (err) |
---|
146 | 270 | return err; |
---|
147 | 271 | } |
---|
.. | .. |
---|
152 | 276 | static int sc27xx_led_probe(struct platform_device *pdev) |
---|
153 | 277 | { |
---|
154 | 278 | struct device *dev = &pdev->dev; |
---|
155 | | - struct device_node *np = dev->of_node, *child; |
---|
| 279 | + struct device_node *np = dev_of_node(dev), *child; |
---|
156 | 280 | struct sc27xx_led_priv *priv; |
---|
157 | | - const char *str; |
---|
158 | 281 | u32 base, count, reg; |
---|
159 | 282 | int err; |
---|
160 | 283 | |
---|
161 | | - count = of_get_child_count(np); |
---|
| 284 | + count = of_get_available_child_count(np); |
---|
162 | 285 | if (!count || count > SC27XX_LEDS_MAX) |
---|
163 | 286 | return -EINVAL; |
---|
164 | 287 | |
---|
.. | .. |
---|
182 | 305 | return err; |
---|
183 | 306 | } |
---|
184 | 307 | |
---|
185 | | - for_each_child_of_node(np, child) { |
---|
| 308 | + for_each_available_child_of_node(np, child) { |
---|
186 | 309 | err = of_property_read_u32(child, "reg", ®); |
---|
187 | 310 | if (err) { |
---|
188 | 311 | of_node_put(child); |
---|
.. | .. |
---|
196 | 319 | return -EINVAL; |
---|
197 | 320 | } |
---|
198 | 321 | |
---|
| 322 | + priv->leds[reg].fwnode = of_fwnode_handle(child); |
---|
199 | 323 | priv->leds[reg].active = true; |
---|
200 | | - |
---|
201 | | - err = of_property_read_string(child, "label", &str); |
---|
202 | | - if (err) |
---|
203 | | - snprintf(priv->leds[reg].name, LED_MAX_NAME_SIZE, |
---|
204 | | - "sc27xx::"); |
---|
205 | | - else |
---|
206 | | - snprintf(priv->leds[reg].name, LED_MAX_NAME_SIZE, |
---|
207 | | - "sc27xx:%s", str); |
---|
208 | 324 | } |
---|
209 | 325 | |
---|
210 | 326 | err = sc27xx_led_register(dev, priv); |
---|
.. | .. |
---|
241 | 357 | |
---|
242 | 358 | MODULE_DESCRIPTION("Spreadtrum SC27xx breathing light controller driver"); |
---|
243 | 359 | MODULE_AUTHOR("Xiaotong Lu <xiaotong.lu@spreadtrum.com>"); |
---|
| 360 | +MODULE_AUTHOR("Baolin Wang <baolin.wang@linaro.org>"); |
---|
244 | 361 | MODULE_LICENSE("GPL v2"); |
---|