On Mon, Aug 03, 2020 at 10:49:23PM +0200, Sascha Hauer wrote: > On Thu, Jul 23, 2020 at 12:33:24PM +0200, Oleksij Rempel wrote: > > Signed-off-by: Oleksij Rempel > > --- > > arch/arm/boards/protonic-imx6/Makefile | 1 + > > arch/arm/boards/protonic-imx6/board.c | 598 +++++++++++++++++++++++++ > > 2 files changed, 599 insertions(+) > > create mode 100644 arch/arm/boards/protonic-imx6/board.c > > > > +static int prt_imx6_nvmem_link_fec(struct prt_imx6_priv *priv, > > + struct device_node *root, > > + struct device_node *nvmem_node) > > +{ > > + struct device_node *fec_node; > > + phandle nvmem_handle; > > + int ret; > > + > > + fec_node = of_find_node_by_alias(root, "ethernet0"); > > + if (!fec_node) { > > + dev_err(priv->dev, "Cant find the fec node\n"); > > + return -ENODEV; > > + } > > + > > + nvmem_handle = of_node_create_phandle(nvmem_node); > > + > > + ret = of_property_write_u32(fec_node, "nvmem-cells", nvmem_handle); > > + if (ret) > > + return ret; > > + > > + ret = of_property_write_string(fec_node, "nvmem-cell-names", > > + "mac-address"); > > + if (ret) > > + return ret; > > + > > + return 0; > > +} > > barebox will already write the "mac-address" property to the fec node. > Isn't this enough? My motivation for doing this is following: - we can't make sure i2c is already probed at this point - if we will decide to speed up the boot, it will be more effective to let linux read the eeprom - usually, vendors tend to avoid updating the bootloader in the field. So, it is better to provide all needed information the devicetree to let the linux make the right choice. - in long term, even in barebox we will need to work deferred probe. So, it is better to prepare the devicetree and let the system do all needed work. > > + > > +static struct device_node * > > +prt_imx6_create_nvmem_cells(struct prt_imx6_priv *priv, > > + struct device_node *nvmem_node, > > + const char *node_name, size_t offset, size_t size) > > +{ > > + struct device_node *nvcell_node; > > + int na, ns, len = 0; > > + int ret; > > + u8 *tmp; > > + > > + nvcell_node = of_create_node(nvmem_node, node_name); > > + if (!nvcell_node) { > > + dev_err(priv->dev, "Failed to create %s cell\n", node_name); > > + return ERR_PTR(-ENOMEM); > > + } > > + > > + na = of_n_addr_cells(nvcell_node); > > + ns = of_n_size_cells(nvcell_node); > > + tmp = xzalloc((na + ns) * 4); > > + > > + of_write_number(tmp + len, offset, na); > > + len += na * 4; > > + of_write_number(tmp + len, size, ns); > > + len += ns * 4; > > + > > + ret = of_set_property(nvcell_node, "reg", tmp, len, 1); > > + kfree(tmp); > > + if (ret) > > + return ERR_PTR(ret); > > + > > + return nvcell_node; > > +} > > + > > +static int prt_imx6_rfid_fixup(struct device_node *root, void *data) > > +{ > > + struct prt_imx6_priv *priv = data; > > + const struct prt_machine_data *dcfg = priv->dcfg; > > + struct device_node *node, *i2c_node, *tmp_node; > > + char *eeprom_node_name, *alias; > > + int na, ns, len = 0; > > + int ret; > > + u8 *tmp; > > + > > + if (!root) { > > + dev_err(priv->dev, "Unable to find the root node\n"); > > + return -ENODEV; > > + } > > + > > + alias = basprintf("i2c%d", dcfg->i2c_adapter); > > + if (!alias) { > > + ret = -ENOMEM; > > + goto exit_error; > > + } > > + > > + i2c_node = of_find_node_by_alias(root, alias); > > + if (!i2c_node) { > > + dev_err(priv->dev, "Unsupported i2c adapter\n"); > > + ret = -ENODEV; > > + goto free_alias; > > + } > > + > > + eeprom_node_name = basprintf("/eeprom@%x", dcfg->i2c_addr); > > + if (!eeprom_node_name) { > > + ret = -ENOMEM; > > + goto free_alias; > > + } > > + > > + node = of_create_node(i2c_node, eeprom_node_name); > > + if (!node) { > > + dev_err(priv->dev, "Filed to create node %s\n", > > + eeprom_node_name); > > s/filed/failed/, multiple times in this patch. fixed > > + ret = -ENOMEM; > > + goto free_eeprom; > > + } > > + > > + ret = of_property_write_string(node, "compatible", "atmel,24c256"); > > + if (ret) > > + goto free_eeprom; > > + > > + na = of_n_addr_cells(node); > > + ns = of_n_size_cells(node); > > + tmp = xzalloc((na + ns) * 4); > > + > > + of_write_number(tmp + len, dcfg->i2c_addr, na); > > + len += na * 4; > > + of_write_number(tmp + len, 0, ns); > > + len += ns * 4; > > + > > + ret = of_set_property(node, "reg", tmp, len, 1); > > + kfree(tmp); > > + if (ret) > > + goto free_eeprom; > > + > > + ret = of_property_write_u32(node, "#size-cells", 1); > > + if (ret) > > + goto free_eeprom; > > + > > + ret = of_property_write_u32(node, "#address-cells", 1); > > + if (ret) > > + goto free_eeprom; > > + > > + tmp_node = prt_imx6_create_nvmem_cells(priv, node, "/mac-address@0", > > + 0x6000, 6); > > + if (IS_ERR(tmp_node)) { > > + ret = PTR_ERR(tmp_node); > > + goto free_eeprom; > > + } > > + > > + ret = prt_imx6_nvmem_link_fec(priv, root, tmp_node); > > + if (ret) > > + goto free_eeprom; > > + > > + tmp_node = prt_imx6_create_nvmem_cells(priv, node, "/serial@6", > > + 0x6006, 10); > > + if (IS_ERR(tmp_node)) { > > + ret = PTR_ERR(tmp_node); > > + goto free_eeprom; > > + } > > + > > + ret = prt_imx6_nvmem_link_serial(priv, root, tmp_node); > > + if (ret) > > + goto free_eeprom; > > + > > + return 0; > > +free_eeprom: > > + kfree(eeprom_node_name); > > +free_alias: > > + kfree(alias); > > +exit_error: > > + dev_err(priv->dev, "Failed to apply fixup\n"); > > It's always nice to print the error code along with such a message. fixed > > +static int prt_imx6_probe(struct device_d *dev) > > +{ > > + struct prt_imx6_priv *priv; > > + struct param_d *p; > > + int ret; > > + > > + priv = kzalloc(sizeof(*priv), GFP_KERNEL); > > + if (!priv) { > > + ret = -ENOMEM; > > + goto exit_probe; > > + } > > + > > + priv->dev = dev; > > + > > + pr_info("Detected machine type: %s\n", > > + of_device_get_match_compatible(priv->dev)); > > + > > + ret = prt_imx6_get_id(priv); > > + if (ret) > > + goto free_priv; > > + > > + pr_info(" HW type: %d\n", priv->hw_id); > > + pr_info(" HW revision: %d\n", priv->hw_rev); > > + > > + ret = prt_imx6_get_dcfg(priv); > > + if (ret) > > + goto free_priv; > > + > > + if (priv->dcfg->init) { > > + ret = priv->dcfg->init(priv); > > + if (ret) > > + goto free_priv; > > + } > > + > > + p = dev_add_param_uint32_ro(dev, "boardrev", &priv->hw_rev, "%u"); > > + if (IS_ERR(p)) { > > + ret = PTR_ERR(p); > > + goto free_priv; > > + } > > + > > + p = dev_add_param_uint32_ro(dev, "boardid", &priv->hw_id, "%u"); > > + if (IS_ERR(p)) { > > + ret = PTR_ERR(p); > > + goto free_priv; > > + } > > + > > + ret = prt_imx6_rfid_fixup(of_get_root_node(), priv); > > + if (ret) > > + goto free_priv; > > + > > + ret = of_register_fixup(prt_imx6_rfid_fixup, priv); > > + if (ret) { > > + dev_err(dev, "Failed to register fixup\n"); > > + goto free_priv; > > + } > > + > > + return 0; > > +free_priv: > > + kfree(priv); > > +exit_probe: > > + dev_err(dev, "Probe filed\n"); fixed Regards, Oleksij -- Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 |