112 static inline void lpc18xx_pwm_writel(struct lpc18xx_pwm_chip *lpc18xx_pwm,  in lpc18xx_pwm_writel()  argument
115 	writel(val, lpc18xx_pwm->base + reg);  in lpc18xx_pwm_writel()
118 static inline u32 lpc18xx_pwm_readl(struct lpc18xx_pwm_chip *lpc18xx_pwm,  in lpc18xx_pwm_readl()  argument
121 	return readl(lpc18xx_pwm->base + reg);  in lpc18xx_pwm_readl()
124 static void lpc18xx_pwm_set_conflict_res(struct lpc18xx_pwm_chip *lpc18xx_pwm,  in lpc18xx_pwm_set_conflict_res()  argument
130 	mutex_lock(&lpc18xx_pwm->res_lock);  in lpc18xx_pwm_set_conflict_res()
137 	val = lpc18xx_pwm_readl(lpc18xx_pwm, LPC18XX_PWM_RES_BASE);  in lpc18xx_pwm_set_conflict_res()
140 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_RES_BASE, val);  in lpc18xx_pwm_set_conflict_res()
142 	mutex_unlock(&lpc18xx_pwm->res_lock);  in lpc18xx_pwm_set_conflict_res()
147 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_config_period()  local
150 	val = (u64)period_ns * lpc18xx_pwm->clk_rate;  in lpc18xx_pwm_config_period()
153 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_config_period()
154 			   LPC18XX_PWM_MATCH(lpc18xx_pwm->period_event),  in lpc18xx_pwm_config_period()
157 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_config_period()
158 			   LPC18XX_PWM_MATCHREL(lpc18xx_pwm->period_event),  in lpc18xx_pwm_config_period()
165 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_config_duty()  local
169 	val = (u64)duty_ns * lpc18xx_pwm->clk_rate;  in lpc18xx_pwm_config_duty()
172 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_config_duty()
176 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_config_duty()
184 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_config()  local
187 	if (period_ns < lpc18xx_pwm->min_period_ns ||  in lpc18xx_pwm_config()
188 	    period_ns > lpc18xx_pwm->max_period_ns) {  in lpc18xx_pwm_config()
193 	mutex_lock(&lpc18xx_pwm->period_lock);  in lpc18xx_pwm_config()
195 	requested_events = bitmap_weight(&lpc18xx_pwm->event_map,  in lpc18xx_pwm_config()
203 	if (requested_events > 2 && lpc18xx_pwm->period_ns != period_ns &&  in lpc18xx_pwm_config()
204 	    lpc18xx_pwm->period_ns) {  in lpc18xx_pwm_config()
207 		mutex_unlock(&lpc18xx_pwm->period_lock);  in lpc18xx_pwm_config()
211 	if ((requested_events <= 2 && lpc18xx_pwm->period_ns != period_ns) ||  in lpc18xx_pwm_config()
212 	    !lpc18xx_pwm->period_ns) {  in lpc18xx_pwm_config()
213 		lpc18xx_pwm->period_ns = period_ns;  in lpc18xx_pwm_config()
219 	mutex_unlock(&lpc18xx_pwm->period_lock);  in lpc18xx_pwm_config()
235 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_enable()  local
240 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_enable()
245 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_enable()
250 		set_event = lpc18xx_pwm->period_event;  in lpc18xx_pwm_enable()
255 		clear_event = lpc18xx_pwm->period_event;  in lpc18xx_pwm_enable()
259 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_OUTPUTSET(pwm->hwpwm),  in lpc18xx_pwm_enable()
261 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_OUTPUTCL(pwm->hwpwm),  in lpc18xx_pwm_enable()
263 	lpc18xx_pwm_set_conflict_res(lpc18xx_pwm, pwm, res_action);  in lpc18xx_pwm_enable()
270 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_disable()  local
273 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_disable()
275 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_OUTPUTSET(pwm->hwpwm), 0);  in lpc18xx_pwm_disable()
276 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_OUTPUTCL(pwm->hwpwm), 0);  in lpc18xx_pwm_disable()
281 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_request()  local
285 	event = find_first_zero_bit(&lpc18xx_pwm->event_map,  in lpc18xx_pwm_request()
289 		dev_err(lpc18xx_pwm->dev,  in lpc18xx_pwm_request()
294 	set_bit(event, &lpc18xx_pwm->event_map);  in lpc18xx_pwm_request()
302 	struct lpc18xx_pwm_chip *lpc18xx_pwm = to_lpc18xx_pwm_chip(chip);  in lpc18xx_pwm_free()  local
305 	clear_bit(lpc18xx_data->duty_event, &lpc18xx_pwm->event_map);  in lpc18xx_pwm_free()
326 	struct lpc18xx_pwm_chip *lpc18xx_pwm;  in lpc18xx_pwm_probe()  local
331 	lpc18xx_pwm = devm_kzalloc(&pdev->dev, sizeof(*lpc18xx_pwm),  in lpc18xx_pwm_probe()
333 	if (!lpc18xx_pwm)  in lpc18xx_pwm_probe()
336 	lpc18xx_pwm->dev = &pdev->dev;  in lpc18xx_pwm_probe()
338 	lpc18xx_pwm->base = devm_platform_ioremap_resource(pdev, 0);  in lpc18xx_pwm_probe()
339 	if (IS_ERR(lpc18xx_pwm->base))  in lpc18xx_pwm_probe()
340 		return PTR_ERR(lpc18xx_pwm->base);  in lpc18xx_pwm_probe()
342 	lpc18xx_pwm->pwm_clk = devm_clk_get(&pdev->dev, "pwm");  in lpc18xx_pwm_probe()
343 	if (IS_ERR(lpc18xx_pwm->pwm_clk)) {  in lpc18xx_pwm_probe()
345 		return PTR_ERR(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_probe()
348 	ret = clk_prepare_enable(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_probe()
354 	lpc18xx_pwm->clk_rate = clk_get_rate(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_probe()
355 	if (!lpc18xx_pwm->clk_rate) {  in lpc18xx_pwm_probe()
361 	mutex_init(&lpc18xx_pwm->res_lock);  in lpc18xx_pwm_probe()
362 	mutex_init(&lpc18xx_pwm->period_lock);  in lpc18xx_pwm_probe()
365 	do_div(val, lpc18xx_pwm->clk_rate);  in lpc18xx_pwm_probe()
366 	lpc18xx_pwm->max_period_ns = val;  in lpc18xx_pwm_probe()
368 	lpc18xx_pwm->min_period_ns = DIV_ROUND_UP(NSEC_PER_SEC,  in lpc18xx_pwm_probe()
369 						  lpc18xx_pwm->clk_rate);  in lpc18xx_pwm_probe()
371 	lpc18xx_pwm->chip.dev = &pdev->dev;  in lpc18xx_pwm_probe()
372 	lpc18xx_pwm->chip.ops = &lpc18xx_pwm_ops;  in lpc18xx_pwm_probe()
373 	lpc18xx_pwm->chip.base = -1;  in lpc18xx_pwm_probe()
374 	lpc18xx_pwm->chip.npwm = 16;  in lpc18xx_pwm_probe()
375 	lpc18xx_pwm->chip.of_xlate = of_pwm_xlate_with_flags;  in lpc18xx_pwm_probe()
376 	lpc18xx_pwm->chip.of_pwm_n_cells = 3;  in lpc18xx_pwm_probe()
379 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_CONFIG,  in lpc18xx_pwm_probe()
386 	set_bit(LPC18XX_PWM_EVENT_PERIOD, &lpc18xx_pwm->event_map);  in lpc18xx_pwm_probe()
387 	lpc18xx_pwm->period_event = LPC18XX_PWM_EVENT_PERIOD;  in lpc18xx_pwm_probe()
389 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_probe()
390 			   LPC18XX_PWM_EVSTATEMSK(lpc18xx_pwm->period_event),  in lpc18xx_pwm_probe()
393 	val = LPC18XX_PWM_EVCTRL_MATCH(lpc18xx_pwm->period_event) |  in lpc18xx_pwm_probe()
395 	lpc18xx_pwm_writel(lpc18xx_pwm,  in lpc18xx_pwm_probe()
396 			   LPC18XX_PWM_EVCTRL(lpc18xx_pwm->period_event), val);  in lpc18xx_pwm_probe()
398 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_LIMIT,  in lpc18xx_pwm_probe()
399 			   BIT(lpc18xx_pwm->period_event));  in lpc18xx_pwm_probe()
401 	for (i = 0; i < lpc18xx_pwm->chip.npwm; i++) {  in lpc18xx_pwm_probe()
404 		pwm = &lpc18xx_pwm->chip.pwms[i];  in lpc18xx_pwm_probe()
406 		data = devm_kzalloc(lpc18xx_pwm->dev, sizeof(*data),  in lpc18xx_pwm_probe()
416 	val = lpc18xx_pwm_readl(lpc18xx_pwm, LPC18XX_PWM_CTRL);  in lpc18xx_pwm_probe()
421 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_CTRL, val);  in lpc18xx_pwm_probe()
423 	ret = pwmchip_add(&lpc18xx_pwm->chip);  in lpc18xx_pwm_probe()
429 	platform_set_drvdata(pdev, lpc18xx_pwm);  in lpc18xx_pwm_probe()
434 	clk_disable_unprepare(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_probe()
440 	struct lpc18xx_pwm_chip *lpc18xx_pwm = platform_get_drvdata(pdev);  in lpc18xx_pwm_remove()  local
443 	val = lpc18xx_pwm_readl(lpc18xx_pwm, LPC18XX_PWM_CTRL);  in lpc18xx_pwm_remove()
444 	lpc18xx_pwm_writel(lpc18xx_pwm, LPC18XX_PWM_CTRL,  in lpc18xx_pwm_remove()
447 	clk_disable_unprepare(lpc18xx_pwm->pwm_clk);  in lpc18xx_pwm_remove()
449 	return pwmchip_remove(&lpc18xx_pwm->chip);  in lpc18xx_pwm_remove()