57 static void mtk_disp_pwm_update_bits(struct mtk_disp_pwm *mdp, u32 offset,  in mtk_disp_pwm_update_bits()  argument
60 	void __iomem *address = mdp->base + offset;  in mtk_disp_pwm_update_bits()
72 	struct mtk_disp_pwm *mdp = to_mtk_disp_pwm(chip);  in mtk_disp_pwm_config()  local
77 	err = clk_prepare_enable(mdp->clk_main);  in mtk_disp_pwm_config()
83 	err = clk_prepare_enable(mdp->clk_mm);  in mtk_disp_pwm_config()
86 		clk_disable_unprepare(mdp->clk_main);  in mtk_disp_pwm_config()
100 	rate = clk_get_rate(mdp->clk_main);  in mtk_disp_pwm_config()
104 		clk_disable_unprepare(mdp->clk_mm);  in mtk_disp_pwm_config()
105 		clk_disable_unprepare(mdp->clk_main);  in mtk_disp_pwm_config()
117 	if (mdp->data->bls_debug && !mdp->data->has_commit) {  in mtk_disp_pwm_config()
122 		mtk_disp_pwm_update_bits(mdp, mdp->data->bls_debug,  in mtk_disp_pwm_config()
123 					 mdp->data->bls_debug_mask,  in mtk_disp_pwm_config()
124 					 mdp->data->bls_debug_mask);  in mtk_disp_pwm_config()
125 		mtk_disp_pwm_update_bits(mdp, mdp->data->con0,  in mtk_disp_pwm_config()
126 					 mdp->data->con0_sel,  in mtk_disp_pwm_config()
127 					 mdp->data->con0_sel);  in mtk_disp_pwm_config()
130 	mtk_disp_pwm_update_bits(mdp, mdp->data->con0,  in mtk_disp_pwm_config()
133 	mtk_disp_pwm_update_bits(mdp, mdp->data->con1,  in mtk_disp_pwm_config()
137 	if (mdp->data->has_commit) {  in mtk_disp_pwm_config()
138 		mtk_disp_pwm_update_bits(mdp, mdp->data->commit,  in mtk_disp_pwm_config()
139 					 mdp->data->commit_mask,  in mtk_disp_pwm_config()
140 					 mdp->data->commit_mask);  in mtk_disp_pwm_config()
141 		mtk_disp_pwm_update_bits(mdp, mdp->data->commit,  in mtk_disp_pwm_config()
142 					 mdp->data->commit_mask,  in mtk_disp_pwm_config()
146 	clk_disable_unprepare(mdp->clk_mm);  in mtk_disp_pwm_config()
147 	clk_disable_unprepare(mdp->clk_main);  in mtk_disp_pwm_config()
154 	struct mtk_disp_pwm *mdp = to_mtk_disp_pwm(chip);  in mtk_disp_pwm_enable()  local
157 	err = clk_prepare_enable(mdp->clk_main);  in mtk_disp_pwm_enable()
163 	err = clk_prepare_enable(mdp->clk_mm);  in mtk_disp_pwm_enable()
166 		clk_disable_unprepare(mdp->clk_main);  in mtk_disp_pwm_enable()
170 	mtk_disp_pwm_update_bits(mdp, DISP_PWM_EN, mdp->data->enable_mask,  in mtk_disp_pwm_enable()
171 				 mdp->data->enable_mask);  in mtk_disp_pwm_enable()
178 	struct mtk_disp_pwm *mdp = to_mtk_disp_pwm(chip);  in mtk_disp_pwm_disable()  local
180 	mtk_disp_pwm_update_bits(mdp, DISP_PWM_EN, mdp->data->enable_mask,  in mtk_disp_pwm_disable()
183 	clk_disable_unprepare(mdp->clk_mm);  in mtk_disp_pwm_disable()
184 	clk_disable_unprepare(mdp->clk_main);  in mtk_disp_pwm_disable()
196 	struct mtk_disp_pwm *mdp;  in mtk_disp_pwm_probe()  local
200 	mdp = devm_kzalloc(&pdev->dev, sizeof(*mdp), GFP_KERNEL);  in mtk_disp_pwm_probe()
201 	if (!mdp)  in mtk_disp_pwm_probe()
204 	mdp->data = of_device_get_match_data(&pdev->dev);  in mtk_disp_pwm_probe()
207 	mdp->base = devm_ioremap_resource(&pdev->dev, r);  in mtk_disp_pwm_probe()
208 	if (IS_ERR(mdp->base))  in mtk_disp_pwm_probe()
209 		return PTR_ERR(mdp->base);  in mtk_disp_pwm_probe()
211 	mdp->clk_main = devm_clk_get(&pdev->dev, "main");  in mtk_disp_pwm_probe()
212 	if (IS_ERR(mdp->clk_main))  in mtk_disp_pwm_probe()
213 		return PTR_ERR(mdp->clk_main);  in mtk_disp_pwm_probe()
215 	mdp->clk_mm = devm_clk_get(&pdev->dev, "mm");  in mtk_disp_pwm_probe()
216 	if (IS_ERR(mdp->clk_mm))  in mtk_disp_pwm_probe()
217 		return PTR_ERR(mdp->clk_mm);  in mtk_disp_pwm_probe()
219 	mdp->chip.dev = &pdev->dev;  in mtk_disp_pwm_probe()
220 	mdp->chip.ops = &mtk_disp_pwm_ops;  in mtk_disp_pwm_probe()
221 	mdp->chip.base = -1;  in mtk_disp_pwm_probe()
222 	mdp->chip.npwm = 1;  in mtk_disp_pwm_probe()
224 	ret = pwmchip_add(&mdp->chip);  in mtk_disp_pwm_probe()
230 	platform_set_drvdata(pdev, mdp);  in mtk_disp_pwm_probe()
237 	struct mtk_disp_pwm *mdp = platform_get_drvdata(pdev);  in mtk_disp_pwm_remove()  local
239 	pwmchip_remove(&mdp->chip);  in mtk_disp_pwm_remove()