|
@@ -29,7 +29,9 @@
|
|
|
#define PWMGDUR 0x0c
|
|
|
#define PWMWAVENUM 0x28
|
|
|
#define PWMDWIDTH 0x2c
|
|
|
+#define PWM45DWIDTH_FIXUP 0x30
|
|
|
#define PWMTHRES 0x30
|
|
|
+#define PWM45THRES_FIXUP 0x34
|
|
|
|
|
|
#define PWM_CLK_DIV_MAX 7
|
|
|
|
|
@@ -54,6 +56,7 @@ static const char * const mtk_pwm_clk_name[MTK_CLK_MAX] = {
|
|
|
|
|
|
struct mtk_pwm_platform_data {
|
|
|
unsigned int num_pwms;
|
|
|
+ bool pwm45_fixup;
|
|
|
};
|
|
|
|
|
|
/**
|
|
@@ -66,6 +69,7 @@ struct mtk_pwm_chip {
|
|
|
struct pwm_chip chip;
|
|
|
void __iomem *regs;
|
|
|
struct clk *clks[MTK_CLK_MAX];
|
|
|
+ const struct mtk_pwm_platform_data *soc;
|
|
|
};
|
|
|
|
|
|
static const unsigned int mtk_pwm_reg_offset[] = {
|
|
@@ -131,18 +135,25 @@ static int mtk_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm,
|
|
|
{
|
|
|
struct mtk_pwm_chip *pc = to_mtk_pwm_chip(chip);
|
|
|
struct clk *clk = pc->clks[MTK_CLK_PWM1 + pwm->hwpwm];
|
|
|
- u32 resolution, clkdiv = 0;
|
|
|
+ u32 clkdiv = 0, cnt_period, cnt_duty, reg_width = PWMDWIDTH,
|
|
|
+ reg_thres = PWMTHRES;
|
|
|
+ u64 resolution;
|
|
|
int ret;
|
|
|
|
|
|
ret = mtk_pwm_clk_enable(chip, pwm);
|
|
|
if (ret < 0)
|
|
|
return ret;
|
|
|
|
|
|
- resolution = NSEC_PER_SEC / clk_get_rate(clk);
|
|
|
+ /* Using resolution in picosecond gets accuracy higher */
|
|
|
+ resolution = (u64)NSEC_PER_SEC * 1000;
|
|
|
+ do_div(resolution, clk_get_rate(clk));
|
|
|
|
|
|
- while (period_ns / resolution > 8191) {
|
|
|
+ cnt_period = DIV_ROUND_CLOSEST_ULL((u64)period_ns * 1000, resolution);
|
|
|
+ while (cnt_period > 8191) {
|
|
|
resolution *= 2;
|
|
|
clkdiv++;
|
|
|
+ cnt_period = DIV_ROUND_CLOSEST_ULL((u64)period_ns * 1000,
|
|
|
+ resolution);
|
|
|
}
|
|
|
|
|
|
if (clkdiv > PWM_CLK_DIV_MAX) {
|
|
@@ -151,9 +162,19 @@ static int mtk_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm,
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
+ if (pc->soc->pwm45_fixup && pwm->hwpwm > 2) {
|
|
|
+ /*
|
|
|
+ * PWM[4,5] has distinct offset for PWMDWIDTH and PWMTHRES
|
|
|
+ * from the other PWMs on MT7623.
|
|
|
+ */
|
|
|
+ reg_width = PWM45DWIDTH_FIXUP;
|
|
|
+ reg_thres = PWM45THRES_FIXUP;
|
|
|
+ }
|
|
|
+
|
|
|
+ cnt_duty = DIV_ROUND_CLOSEST_ULL((u64)duty_ns * 1000, resolution);
|
|
|
mtk_pwm_writel(pc, pwm->hwpwm, PWMCON, BIT(15) | clkdiv);
|
|
|
- mtk_pwm_writel(pc, pwm->hwpwm, PWMDWIDTH, period_ns / resolution);
|
|
|
- mtk_pwm_writel(pc, pwm->hwpwm, PWMTHRES, duty_ns / resolution);
|
|
|
+ mtk_pwm_writel(pc, pwm->hwpwm, reg_width, cnt_period);
|
|
|
+ mtk_pwm_writel(pc, pwm->hwpwm, reg_thres, cnt_duty);
|
|
|
|
|
|
mtk_pwm_clk_disable(chip, pwm);
|
|
|
|
|
@@ -211,6 +232,7 @@ static int mtk_pwm_probe(struct platform_device *pdev)
|
|
|
data = of_device_get_match_data(&pdev->dev);
|
|
|
if (data == NULL)
|
|
|
return -EINVAL;
|
|
|
+ pc->soc = data;
|
|
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
pc->regs = devm_ioremap_resource(&pdev->dev, res);
|
|
@@ -251,14 +273,17 @@ static int mtk_pwm_remove(struct platform_device *pdev)
|
|
|
|
|
|
static const struct mtk_pwm_platform_data mt2712_pwm_data = {
|
|
|
.num_pwms = 8,
|
|
|
+ .pwm45_fixup = false,
|
|
|
};
|
|
|
|
|
|
static const struct mtk_pwm_platform_data mt7622_pwm_data = {
|
|
|
.num_pwms = 6,
|
|
|
+ .pwm45_fixup = false,
|
|
|
};
|
|
|
|
|
|
static const struct mtk_pwm_platform_data mt7623_pwm_data = {
|
|
|
.num_pwms = 5,
|
|
|
+ .pwm45_fixup = true,
|
|
|
};
|
|
|
|
|
|
static const struct of_device_id mtk_pwm_of_match[] = {
|
|
@@ -280,5 +305,4 @@ static struct platform_driver mtk_pwm_driver = {
|
|
|
module_platform_driver(mtk_pwm_driver);
|
|
|
|
|
|
MODULE_AUTHOR("John Crispin <blogic@openwrt.org>");
|
|
|
-MODULE_ALIAS("platform:mtk-pwm");
|
|
|
MODULE_LICENSE("GPL");
|