[PATCH v2 1/7] pinctrl: imx1 core driver
Markus Pargmann
mpa at pengutronix.de
Fri Aug 30 08:17:32 EDT 2013
Hi,
sorry for the late response, I moved last week.
On Tue, Aug 20, 2013 at 08:56:17PM +0800, Shawn Guo wrote:
> Looks good to me. A couple of small comments below.
>
> On Mon, Aug 19, 2013 at 04:07:08PM +0200, Markus Pargmann wrote:
> > +/*
> > + * Write to a register with 2 bits per pin. The function will automatically
> > + * use the next register if the pin is managed in the second register.
> > + */
> > +static void imx1_write_2bit(struct imx1_pinctrl *ipctl, unsigned int pin_id,
> > + u32 value, u32 reg_offset)
> > +{
> > + void __iomem *reg = imx1_mem(ipctl, pin_id) + reg_offset;
> > + int offset = (pin_id % 16) * 2; /* offset, regardless of register used */
> > + int mask = ~(0x3 << offset); /* Mask for 2 bits at offset */
> > + u32 old_val;
> > + u32 new_val;
> > +
> > + dev_dbg(ipctl->dev, "write: register 0x%p offset %d value 0x%x\n",
> > + reg, offset, value);
> > +
> > + /* Use the next register if the pin's port pin number is >=16 */
> > + if (pin_id % 32 >= 16)
> > + reg += 0x04;
> > +
> > + /* Get current state of pins */
> > + old_val = readl(reg);
> > + old_val &= mask;
> > +
> > + new_val = value & 0x3; /* Make sure value is really 2 bit */
> > + new_val <<= offset;
> > + new_val |= old_val;/* Set new state for pin_id */
> > +
> > + writel(new_val, reg);
> > +}
> > +
> > +static void imx1_write_bit(struct imx1_pinctrl *ipctl, unsigned int pin_id,
> > + u32 value, u32 reg_offset)
> > +{
> > + void __iomem *reg = imx1_mem(ipctl, pin_id) + reg_offset;
> > + int offset = pin_id % 32;
> > + int mask = ~BIT_MASK(offset);
> > + u32 old_val;
> > + u32 new_val;
> > +
> > + /* Get current state of pins */
> > + old_val = readl(reg);
> > + old_val &= mask;
> > +
> > + new_val = value & 0x1; /* Make sure value is really 2 bit */
>
> Copy&past error in comment.
>
> > + new_val <<= offset;
> > + new_val |= old_val;/* Set new state for pin_id */
> > +
> > + writel(new_val, reg);
> > +}
>
> <snip>
>
> > +static int imx1_pinctrl_parse_groups(struct device_node *np,
> > + struct imx1_pin_group *grp,
> > + struct imx1_pinctrl_soc_info *info,
> > + u32 index)
> > +{
> > + int size;
> > + const __be32 *list;
> > + int i;
> > +
> > + dev_dbg(info->dev, "group(%d): %s\n", index, np->name);
> > +
> > + /* Initialise group */
> > + grp->name = np->name;
> > +
> > + /*
> > + * the binding format is fsl,pins = <PIN_FUNC_ID CONFIG ...>,
>
> It does not match the bindings.
>
> > + * do sanity check and calculate pins number
> > + */
> > + list = of_get_property(np, "fsl,pins", &size);
> > + /* we do not check return since it's safe node passed down */
> > + if (!size || size % 12) {
> > + dev_notice(info->dev, "Not a valid fsl,pins property (%s)\n",
> > + np->name);
> > + return -EINVAL;
> > + }
> > +
> > + grp->npins = size / 12;
> > + grp->pins = devm_kzalloc(info->dev,
> > + grp->npins * sizeof(struct imx1_pin), GFP_KERNEL);
> > + grp->pin_ids = devm_kzalloc(info->dev,
> > + grp->npins * sizeof(unsigned int), GFP_KERNEL);
> > +
> > + if (!grp->pins || !grp->pin_ids)
> > + return -ENOMEM;
> > +
> > + for (i = 0; i < grp->npins; i++) {
> > + grp->pins[i].pin_id = be32_to_cpu(*list++);
> > + grp->pins[i].mux_id = be32_to_cpu(*list++);
> > + grp->pins[i].config = be32_to_cpu(*list++);
> > +
> > + grp->pin_ids[i] = grp->pins[i].pin_id;
> > + }
> > +
> > + return 0;
> > +}
>
> <snip>
>
> > +static int imx1_pinctrl_parse_dt(struct platform_device *pdev,
> > + struct imx1_pinctrl *pctl, struct imx1_pinctrl_soc_info *info)
> > +{
> > + struct device_node *np = pdev->dev.of_node;
> > + struct device_node *child;
> > + int ret;
> > + u32 nfuncs = 0;
> > + u32 ngroups = 0;
> > + u32 ifunc = 0;
> > + u32 base_addr;
> > +
> > + if (!np)
> > + return -ENODEV;
> > +
> > + ret = of_property_read_u32(np, "reg", &base_addr);
>
> It seems base_addr is used nowhere?
It's not used anymore. Some old code I forgot to remove from the gpio
subdevices.
I also fixed the comments you mentioned.
Thanks,
Markus
>
> Shawn
>
> > + if (ret)
> > + return ret;
> > +
> > + for_each_child_of_node(np, child) {
> > + ++nfuncs;
> > + ngroups += of_get_child_count(child);
> > + }
> > +
> > + if (!nfuncs) {
> > + dev_err(&pdev->dev, "No pin functions defined\n");
> > + return -EINVAL;
> > + }
> > +
> > + info->nfunctions = nfuncs;
> > + info->functions = devm_kzalloc(&pdev->dev,
> > + nfuncs * sizeof(struct imx1_pmx_func), GFP_KERNEL);
> > +
> > + info->ngroups = ngroups;
> > + info->groups = devm_kzalloc(&pdev->dev,
> > + ngroups * sizeof(struct imx1_pin_group), GFP_KERNEL);
> > +
> > +
> > + if (!info->functions || !info->groups)
> > + return -ENOMEM;
> > +
> > + for_each_child_of_node(np, child) {
> > + ret = imx1_pinctrl_parse_functions(child, info, ifunc++);
> > + if (ret == -ENOMEM)
> > + return -ENOMEM;
> > + }
> > +
> > + return 0;
> > +}
>
>
--
Pengutronix e.K. | |
Industrial Linux Solutions | http://www.pengutronix.de/ |
Peiner Str. 6-8, 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 |
Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |
More information about the linux-arm-kernel
mailing list