115 static inline void lpc18xx_pwm_writel(struct lpc18xx_pwm_chip *lpc18xx_pwm,  in lpc18xx_pwm_writel()  argument
118 	writel(val, lpc18xx_pwm->base + reg);  in lpc18xx_pwm_writel()
121 static inline u32 lpc18xx_pwm_readl(struct lpc18xx_pwm_chip *lpc18xx_pwm,  in lpc18xx_pwm_readl()  argument
124 	return readl(lpc18xx_pwm->base + reg);  in lpc18xx_pwm_readl()
127 static void lpc18xx_pwm_set_conflict_res(struct lpc18xx_pwm_chip *lpc18xx_pwm,  in lpc18xx_pwm_set_conflict_res()  argument
133 	mutex_lock(&lpc18xx_pwm->res_lock);  in lpc18xx_pwm_set_conflict_res()
140 	val = lpc18xx_pwm_readl(lpc18xx_pwm, LPC18XX_PWM_RES_BASE);  in lpc18xx_pwm_set_conflict_res()
143 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_RES_BASE, val);  in lpc18xx_pwm_set_conflict_res()
145 	mutex_unlock(&lpc18xx_pwm->res_lock);  in lpc18xx_pwm_set_conflict_res()
150 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_config_period()  local
153 	val = (u64)period_ns * lpc18xx_pwm->clk_rate;  in lpc18xx_pwm_config_period()
156 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_config_period()
157 			   LPC18XX_PWM_MATCH(lpc18xx_pwm->period_event),  in lpc18xx_pwm_config_period()
160 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_config_period()
161 			   LPC18XX_PWM_MATCHREL(lpc18xx_pwm->period_event),  in lpc18xx_pwm_config_period()
168 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_config_duty()  local
172 	val = (u64)duty_ns * lpc18xx_pwm->clk_rate;  in lpc18xx_pwm_config_duty()
175 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_config_duty()
179 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_config_duty()
187 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_config()  local
190 	if (period_ns < lpc18xx_pwm->min_period_ns ||  in lpc18xx_pwm_config()
191 	    period_ns > lpc18xx_pwm->max_period_ns) {  in lpc18xx_pwm_config()
196 	mutex_lock(&lpc18xx_pwm->period_lock);  in lpc18xx_pwm_config()
198 	requested_events = bitmap_weight(&lpc18xx_pwm->event_map,  in lpc18xx_pwm_config()
206 	if (requested_events > 2 && lpc18xx_pwm->period_ns != period_ns &&  in lpc18xx_pwm_config()
207 	    lpc18xx_pwm->period_ns) {  in lpc18xx_pwm_config()
210 		mutex_unlock(&lpc18xx_pwm->period_lock);  in lpc18xx_pwm_config()
214 	if ((requested_events <= 2 && lpc18xx_pwm->period_ns != period_ns) ||  in lpc18xx_pwm_config()
215 	    !lpc18xx_pwm->period_ns) {  in lpc18xx_pwm_config()
216 		lpc18xx_pwm->period_ns = period_ns;  in lpc18xx_pwm_config()
222 	mutex_unlock(&lpc18xx_pwm->period_lock);  in lpc18xx_pwm_config()
238 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_enable()  local
243 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_enable()
248 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_enable()
253 		set_event = lpc18xx_pwm->period_event;  in lpc18xx_pwm_enable()
258 		clear_event = lpc18xx_pwm->period_event;  in lpc18xx_pwm_enable()
262 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_OUTPUTSET(pwm->hwpwm),  in lpc18xx_pwm_enable()
264 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_OUTPUTCL(pwm->hwpwm),  in lpc18xx_pwm_enable()
266 	lpc18xx_pwm_set_conflict_res(lpc18xx_pwm, pwm, res_action);  in lpc18xx_pwm_enable()
273 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_disable()  local
276 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_disable()
278 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_OUTPUTSET(pwm->hwpwm), 0);  in lpc18xx_pwm_disable()
279 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_OUTPUTCL(pwm->hwpwm), 0);  in lpc18xx_pwm_disable()
284 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_request()  local
288 	event = find_first_zero_bit(&lpc18xx_pwm->event_map,  in lpc18xx_pwm_request()
292 		dev_err(lpc18xx_pwm->dev,  in lpc18xx_pwm_request()
297 	set_bit(event, &lpc18xx_pwm->event_map);  in lpc18xx_pwm_request()
306 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_free()  local
311 	clear_bit(lpc18xx_data->duty_event, &lpc18xx_pwm->event_map);  in lpc18xx_pwm_free()
332 	struct lpc18xx_pwm_chip *lpc18xx_pwm;  in lpc18xx_pwm_probe()  local
338 	lpc18xx_pwm = devm_kzalloc(&pdev->dev, sizeof(*lpc18xx_pwm),  in lpc18xx_pwm_probe()
340 	if (!lpc18xx_pwm)  in lpc18xx_pwm_probe()
343 	lpc18xx_pwm->dev = &pdev->dev;  in lpc18xx_pwm_probe()
346 	lpc18xx_pwm->base = devm_ioremap_resource(&pdev->dev, res);  in lpc18xx_pwm_probe()
347 	if (IS_ERR(lpc18xx_pwm->base))  in lpc18xx_pwm_probe()
348 		return PTR_ERR(lpc18xx_pwm->base);  in lpc18xx_pwm_probe()
350 	lpc18xx_pwm->pwm_clk = devm_clk_get(&pdev->dev, "pwm");  in lpc18xx_pwm_probe()
351 	if (IS_ERR(lpc18xx_pwm->pwm_clk)) {  in lpc18xx_pwm_probe()
353 		return PTR_ERR(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_probe()
356 	ret = clk_prepare_enable(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_probe()
362 	lpc18xx_pwm->clk_rate = clk_get_rate(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_probe()
364 	mutex_init(&lpc18xx_pwm->res_lock);  in lpc18xx_pwm_probe()
365 	mutex_init(&lpc18xx_pwm->period_lock);  in lpc18xx_pwm_probe()
368 	do_div(val, lpc18xx_pwm->clk_rate);  in lpc18xx_pwm_probe()
369 	lpc18xx_pwm->max_period_ns = val;  in lpc18xx_pwm_probe()
371 	lpc18xx_pwm->min_period_ns = DIV_ROUND_UP(NSEC_PER_SEC,  in lpc18xx_pwm_probe()
372 						  lpc18xx_pwm->clk_rate);  in lpc18xx_pwm_probe()
374 	lpc18xx_pwm->chip.dev = &pdev->dev;  in lpc18xx_pwm_probe()
375 	lpc18xx_pwm->chip.ops = &lpc18xx_pwm_ops;  in lpc18xx_pwm_probe()
376 	lpc18xx_pwm->chip.base = -1;  in lpc18xx_pwm_probe()
377 	lpc18xx_pwm->chip.npwm = 16;  in lpc18xx_pwm_probe()
378 	lpc18xx_pwm->chip.of_xlate = of_pwm_xlate_with_flags;  in lpc18xx_pwm_probe()
379 	lpc18xx_pwm->chip.of_pwm_n_cells = 3;  in lpc18xx_pwm_probe()
382 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_CONFIG,  in lpc18xx_pwm_probe()
389 	set_bit(LPC18XX_PWM_EVENT_PERIOD, &lpc18xx_pwm->event_map);  in lpc18xx_pwm_probe()
390 	lpc18xx_pwm->period_event = LPC18XX_PWM_EVENT_PERIOD;  in lpc18xx_pwm_probe()
392 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_probe()
393 			   LPC18XX_PWM_EVSTATEMSK(lpc18xx_pwm->period_event),  in lpc18xx_pwm_probe()
396 	val = LPC18XX_PWM_EVCTRL_MATCH(lpc18xx_pwm->period_event) |  in lpc18xx_pwm_probe()
398 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_probe()
399 			   LPC18XX_PWM_EVCTRL(lpc18xx_pwm->period_event), val);  in lpc18xx_pwm_probe()
401 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_LIMIT,  in lpc18xx_pwm_probe()
402 			   BIT(lpc18xx_pwm->period_event));  in lpc18xx_pwm_probe()
404 	ret = pwmchip_add(&lpc18xx_pwm->chip);  in lpc18xx_pwm_probe()
410 	for (i = 0; i < lpc18xx_pwm->chip.npwm; i++) {  in lpc18xx_pwm_probe()
411 		pwm = &lpc18xx_pwm->chip.pwms[i];  in lpc18xx_pwm_probe()
412 		pwm->chip_data = devm_kzalloc(lpc18xx_pwm->dev,  in lpc18xx_pwm_probe()
421 	platform_set_drvdata(pdev, lpc18xx_pwm);  in lpc18xx_pwm_probe()
423 	val = lpc18xx_pwm_readl(lpc18xx_pwm, LPC18XX_PWM_CTRL);  in lpc18xx_pwm_probe()
428 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_CTRL, val);  in lpc18xx_pwm_probe()
433 	pwmchip_remove(&lpc18xx_pwm->chip);  in lpc18xx_pwm_probe()
435 	clk_disable_unprepare(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_probe()
441 	struct lpc18xx_pwm_chip *lpc18xx_pwm = platform_get_drvdata(pdev);  in lpc18xx_pwm_remove()  local
444 	val = lpc18xx_pwm_readl(lpc18xx_pwm, LPC18XX_PWM_CTRL);  in lpc18xx_pwm_remove()
445 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_CTRL,  in lpc18xx_pwm_remove()
448 	clk_disable_unprepare(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_remove()
450 	return pwmchip_remove(&lpc18xx_pwm->chip);  in lpc18xx_pwm_remove()