[PATCH v2] pwm: meson: external clock configuration for s4

Jiayi Zhou Jiayi.Zhou at amlogic.com
Wed Mar 23 22:29:39 PDT 2022


在 2022/1/14 18:16, Neil Armstrong 写道:
> [ EXTERNAL EMAIL ]
>
> Hi,
>
> On 14/01/2022 10:07, Jiayi.Zhou at amlogic.com wrote:
>> From: "Jiayi.zhou" <jiayi.zhou at amlogic.com>
>>
>> For PWM controller in the Meson-S4 SoC,
>> PWM needs to obtain an external clock source.
>> This patch tries to describe them in the DT compatible data.
> Can you be more explicit here ? On which SoC ? Why ?
>
> As I understand while reading the S805X2 datasheet, now the PWM clock input is
> done in independent CLKCTRL registers and no more in the PWM registers, right ?
>
> So with S4, instead of passing the mux input clock of clkin0 & clkin1, now you pass
> the PWM mux output clock.

For PWM controller in the Meson-S4 SoC,PWM needs to obtain an external clock source.
The configuration for the external clock source will be placed in the dtsi

>> Signed-off-by: Jiayi.zhou <jiayi.zhou at amlogic.com>
>> ---
>>   drivers/pwm/pwm-meson.c | 145 ++++++++++++++++++++++++++++++----------
>>   1 file changed, 110 insertions(+), 35 deletions(-)
>>
>> diff --git a/drivers/pwm/pwm-meson.c b/drivers/pwm/pwm-meson.c
>> index 3cf3bcf5ddfc..54db56c95be2 100644
>> --- a/drivers/pwm/pwm-meson.c
>> +++ b/drivers/pwm/pwm-meson.c
>> @@ -51,6 +51,7 @@
>>   #define REG_MISC_AB		0x8
>>   #define MISC_B_CLK_EN		BIT(23)
>>   #define MISC_A_CLK_EN		BIT(15)
>> +
>>   #define MISC_CLK_DIV_MASK	0x7f
>>   #define MISC_B_CLK_DIV_SHIFT	16
>>   #define MISC_A_CLK_DIV_SHIFT	8
>> @@ -93,11 +94,13 @@ struct meson_pwm_channel {
>>   	struct clk *clk_parent;
>>   	struct clk_mux mux;
>>   	struct clk *clk;
>> +	struct clk *clk_mux;
> Why do you add a mux ?

The purpose of adding a mux is to increase the selection of clock sources.

Before, amlogic only set the GATE attribute of the clock source. This 
time, the SEL attribute was added.

>
>>   };
>>   
>>   struct meson_pwm_data {
>>   	const char * const *parent_names;
>>   	unsigned int num_parents;
>> +	unsigned int extern_clk;
>>   };
>>   
>>   struct meson_pwm {
>> @@ -105,6 +108,7 @@ struct meson_pwm {
>>   	const struct meson_pwm_data *data;
>>   	struct meson_pwm_channel channels[MESON_NUM_PWMS];
>>   	void __iomem *base;
>> +
>>   	/*
>>   	 * Protects register (write) access to the REG_MISC_AB register
>>   	 * that is shared between the two PWMs.
>> @@ -130,13 +134,15 @@ static int meson_pwm_request(struct pwm_chip *chip, struct pwm_device *pwm)
>>   
>>   	channel = &meson->channels[pwm->hwpwm];
>>   
>> -	if (channel->clk_parent) {
>> -		err = clk_set_parent(channel->clk, channel->clk_parent);
>> -		if (err < 0) {
>> -			dev_err(dev, "failed to set parent %s for %s: %d\n",
>> -				__clk_get_name(channel->clk_parent),
>> -				__clk_get_name(channel->clk), err);
>> -			return err;
>> +	if (!meson->data->extern_clk) {
>> +		if (channel->clk_parent) {
>> +			err = clk_set_parent(channel->clk, channel->clk_parent);
>> +			if (err < 0) {
>> +				dev_err(dev, "failed to set parent %s for %s: %d\n",
>> +					__clk_get_name(channel->clk_parent),
>> +					__clk_get_name(channel->clk), err);
>> +					return err;
>> +			}
>>   		}
>>   	}
>>   
>> @@ -171,7 +177,11 @@ static int meson_pwm_calc(struct meson_pwm *meson, struct pwm_device *pwm,
>>   	if (state->polarity == PWM_POLARITY_INVERSED)
>>   		duty = period - duty;
>>   
>> -	fin_freq = clk_get_rate(channel->clk);
>> +	if (meson->data->extern_clk) {
>> +		fin_freq = clk_get_rate(channel->clk_mux);> +	} else {
>> +		fin_freq = clk_get_rate(channel->clk);
>> +	}
>>   	if (fin_freq == 0) {
>>   		dev_err(meson->chip.dev, "invalid source clock frequency\n");
>>   		return -EINVAL;
>> @@ -228,17 +238,32 @@ static void meson_pwm_enable(struct meson_pwm *meson, struct pwm_device *pwm)
>>   	struct meson_pwm_channel_data *channel_data;
>>   	unsigned long flags;
>>   	u32 value;
>> +	unsigned long set_clk;
>> +	u32 err;
>>   
>>   	channel_data = &meson_pwm_per_channel_data[pwm->hwpwm];
>>   
>> -	spin_lock_irqsave(&meson->lock, flags);
>> -
>>   	value = readl(meson->base + REG_MISC_AB);
>> -	value &= ~(MISC_CLK_DIV_MASK << channel_data->clk_div_shift);
>> -	value |= channel->pre_div << channel_data->clk_div_shift;
>> -	value |= channel_data->clk_en_mask;
>> -	writel(value, meson->base + REG_MISC_AB);
>> +	if (meson->data->extern_clk) {
>> +		set_clk = clk_get_rate(channel->clk_mux);
>> +
>> +		if (set_clk == 0)
>> +			dev_err(meson->chip.dev, "invalid source clock frequency\n");
>> +		set_clk /= channel->pre_div + 1;
>> +		err = clk_set_rate(channel->clk, set_clk);
>> +		if (err)
>> +			dev_err(meson->chip.dev, "%s: error in setting pwm rate!\n", __func__);
>> +	} else {
>> +		spin_lock_irqsave(&meson->lock, flags);
>> +
>> +		value &= ~(MISC_CLK_DIV_MASK << channel_data->clk_div_shift);
>> +		value |= channel->pre_div << channel_data->clk_div_shift;
>> +		value |= channel_data->clk_en_mask;
>> +		writel(value, meson->base + REG_MISC_AB);
>>   
>> +		spin_unlock_irqrestore(&meson->lock, flags);
>> +	}
>> +	spin_lock_irqsave(&meson->lock, flags);
>>   	value = FIELD_PREP(PWM_HIGH_MASK, channel->hi) |
>>   		FIELD_PREP(PWM_LOW_MASK, channel->lo);
>>   	writel(value, meson->base + channel_data->reg_offset);
>> @@ -246,7 +271,6 @@ static void meson_pwm_enable(struct meson_pwm *meson, struct pwm_device *pwm)
>>   	value = readl(meson->base + REG_MISC_AB);
>>   	value |= channel_data->pwm_en_mask;
>>   	writel(value, meson->base + REG_MISC_AB);
>> -
>>   	spin_unlock_irqrestore(&meson->lock, flags);
>>   }
>>   
>> @@ -333,7 +357,8 @@ static void meson_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm,
>>   	struct meson_pwm *meson = to_meson_pwm(chip);
>>   	struct meson_pwm_channel_data *channel_data;
>>   	struct meson_pwm_channel *channel;
>> -	u32 value, tmp;
>> +	u32 value_pwm, value, tmp;
>> +	unsigned long gate_clk, fre;
>>   
>>   	if (!state)
>>   		return;
>> @@ -341,30 +366,42 @@ static void meson_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm,
>>   	channel = &meson->channels[pwm->hwpwm];
>>   	channel_data = &meson_pwm_per_channel_data[pwm->hwpwm];
>>   
>> -	value = readl(meson->base + REG_MISC_AB);
>> -
>> -	tmp = channel_data->pwm_en_mask | channel_data->clk_en_mask;
>> -	state->enabled = (value & tmp) == tmp;
>> -
>> -	tmp = value >> channel_data->clk_div_shift;
>> -	channel->pre_div = FIELD_GET(MISC_CLK_DIV_MASK, tmp);
>> -
>> +	value_pwm = readl(meson->base + REG_MISC_AB);
>>   	value = readl(meson->base + channel_data->reg_offset);
>>   
>>   	channel->lo = FIELD_GET(PWM_LOW_MASK, value);
>>   	channel->hi = FIELD_GET(PWM_HIGH_MASK, value);
>>   
>> -	if (channel->lo == 0) {
>> -		state->period = meson_pwm_cnt_to_ns(chip, pwm, channel->hi);
>> -		state->duty_cycle = state->period;
>> -	} else if (channel->lo >= channel->hi) {
>> -		state->period = meson_pwm_cnt_to_ns(chip, pwm,
>> -						    channel->lo + channel->hi);
>> -		state->duty_cycle = meson_pwm_cnt_to_ns(chip, pwm,
>> -							channel->hi);
>> +	if (meson->data->extern_clk) {
>> +		gate_clk = clk_get_rate(channel->clk);
>> +		fre = gate_clk / (channel->lo + channel->hi);
>> +		state->period = div_u64(NSEC_PER_SEC, fre);
>> +		state->duty_cycle = div_u64(state->period * channel->hi, channel->lo + channel->hi);
>> +		tmp = channel_data->pwm_en_mask;
>> +
>> +		if (((value_pwm & tmp) == tmp) && __clk_is_enabled(channel->clk))
>> +			state->enabled = true;
>> +		else
>> +			state->enabled = false;
>>   	} else {
>> -		state->period = 0;
>> -		state->duty_cycle = 0;
>> +		tmp = channel_data->pwm_en_mask | channel_data->clk_en_mask;
>> +
>> +		state->enabled = (value_pwm & tmp) == tmp;
>> +
>> +		tmp = value_pwm >> channel_data->clk_div_shift;
>> +		channel->pre_div = FIELD_GET(MISC_CLK_DIV_MASK, tmp);
>> +
>> +		if (channel->lo == 0) {
>> +			state->period = meson_pwm_cnt_to_ns(chip, pwm, channel->hi);
>> +			state->duty_cycle = state->period;
>> +		} else if (channel->lo >= channel->hi) {
>> +			state->period = meson_pwm_cnt_to_ns(chip, pwm, channel->lo
>> +							    + channel->hi);
>> +			state->duty_cycle = meson_pwm_cnt_to_ns(chip, pwm, channel->hi);
>> +		} else {
>> +			state->period = 0;
>> +			state->duty_cycle = 0;
>> +		}
>>   	}
>>   }
> You need to rewrite the clock calculation entirely, instead of relying on a fin_freq, you need
> to set_rate() the needed rate to the input clock, then calculate the periods on the rate
> set by CCF.
>
> One way is to forget trying to set a rate of the input clock, simply get_rate() of the input clock
> and try to calculate periods on it.
>
> Instead rely on assignes-clock-parent & assigned-clock-rate in DT to set the right parent of the mux
> and rate of the mux post divider to feed to correct rate to the PWM controller.
assignes-clock-parent and assignment-clock-rate I will set in dtsi.
>>   
>> @@ -452,6 +489,10 @@ static const struct meson_pwm_data pwm_g12a_ee_data = {
>>   	.num_parents = ARRAY_SIZE(pwm_g12a_ee_parent_names),
>>   };
>>   
>> +static const struct meson_pwm_data pwm_meson_data = {
>> +	.extern_clk = true,
>> +};
>> +
>>   static const struct of_device_id meson_pwm_matches[] = {
>>   	{
>>   		.compatible = "amlogic,meson8b-pwm",
>> @@ -485,6 +526,10 @@ static const struct of_device_id meson_pwm_matches[] = {
>>   		.compatible = "amlogic,meson-g12a-ao-pwm-cd",
>>   		.data = &pwm_g12a_ao_cd_data
>>   	},
>> +	{
>> +		.compatible = "amlogic,meson-s4-pwm",
>> +		.data = &pwm_meson_data
>> +	},
>>   	{},
>>   };
>>   MODULE_DEVICE_TABLE(of, meson_pwm_matches);
>> @@ -534,6 +579,33 @@ static int meson_pwm_init_channels(struct meson_pwm *meson)
>>   	return 0;
>>   }
>>   
>> +static int meson_pwm_extern_init_channels(struct meson_pwm *meson)
>> +{
>> +	struct meson_pwm_channel *channels = meson->channels;
>> +	struct device *dev = meson->chip.dev;
>> +	unsigned int i;
>> +	char name[255];
>> +
>> +	for (i = 0; i < meson->chip.npwm; i++) {
>> +		snprintf(name, sizeof(name), "clkin%u", i);
>> +		(channels + i)->clk = devm_clk_get(dev, name);
>> +		if (IS_ERR((channels + i)->clk)) {
>> +			dev_err_probe(meson->chip.dev, PTR_ERR((channels + i)->clk),
>> +				      "can't get device clock\n");
>> +			return PTR_ERR((channels + i)->clk);
>> +		}
>> +		snprintf(name, sizeof(name), "mux%u", i);
>> +		(channels + i)->clk_mux = devm_clk_get(dev, name);
>> +		if (IS_ERR((channels + i)->clk_mux)) {
>> +			dev_err_probe(meson->chip.dev, PTR_ERR((channels + i)->clk_mux),
>> +				      "can't get device clock\n");
>> +			return PTR_ERR((channels + i)->clk_mux);
> If you add mux you'll need to changes the bindings.
>
>> +		}
>> +	}
>> +
>> +	return 0;
>> +}
>> +
>>   static int meson_pwm_probe(struct platform_device *pdev)
>>   {
>>   	struct meson_pwm *meson;
>> @@ -553,8 +625,11 @@ static int meson_pwm_probe(struct platform_device *pdev)
>>   	meson->chip.npwm = MESON_NUM_PWMS;
>>   
>>   	meson->data = of_device_get_match_data(&pdev->dev);
>> +	if (meson->data->extern_clk)
>> +		err = meson_pwm_extern_init_channels(meson);
>> +	else
>> +		err = meson_pwm_init_channels(meson);
>>   
>> -	err = meson_pwm_init_channels(meson);
>>   	if (err < 0)
>>   		return err;
>>   
>>
> .



More information about the linux-amlogic mailing list