From mboxrd@z Thu Jan 1 00:00:00 1970 From: Stefan Roese Date: Thu, 29 Nov 2018 14:00:22 +0100 Subject: [U-Boot] [PATCH u-boot-marvell v3 03/10] board: turris_mox: Check and configure modules In-Reply-To: <20181120120409.12822-3-marek.behun@nic.cz> References: <20181120120409.12822-1-marek.behun@nic.cz> <20181120120409.12822-3-marek.behun@nic.cz> Message-ID: <674534d1-b7e9-4204-c263-19112406bc09@denx.de> List-Id: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: 8bit To: u-boot@lists.denx.de On 20.11.18 13:04, Marek Behún wrote: > Check if Mox modules are connected in supported mode, then configure > the MDIO addresses of switch modules. > > Signed-off-by: Marek Behún > --- > arch/arm/dts/armada-3720-turris-mox.dts | 11 ++ > board/CZ.NIC/turris_mox/turris_mox.c | 251 +++++++++++++++++++++++- > 2 files changed, 261 insertions(+), 1 deletion(-) > > diff --git a/arch/arm/dts/armada-3720-turris-mox.dts b/arch/arm/dts/armada-3720-turris-mox.dts > index 7babc16679..9c96dd39a9 100644 > --- a/arch/arm/dts/armada-3720-turris-mox.dts > +++ b/arch/arm/dts/armada-3720-turris-mox.dts > @@ -110,6 +110,17 @@ > spi-max-frequency = <20000000>; > m25p,fast-read; > }; > + > + moxtet at 1 { > + #address-cells = <1>; > + #size-cells = <0>; > + compatible = "cznic,moxtet"; > + reg = <1>; > + devrst-gpio = <&gpiosb 2 GPIO_ACTIVE_LOW>; > + spi-max-frequency = <1000000>; > + spi-cpol; > + spi-cpha; > + }; > }; > > &uart0 { > diff --git a/board/CZ.NIC/turris_mox/turris_mox.c b/board/CZ.NIC/turris_mox/turris_mox.c > index 3c0ab58756..39c26416a7 100644 > --- a/board/CZ.NIC/turris_mox/turris_mox.c > +++ b/board/CZ.NIC/turris_mox/turris_mox.c > @@ -4,11 +4,13 @@ > */ > > #include > +#include > #include > #include > #include > #include > #include > +#include > #include > #include > #include > @@ -239,11 +241,138 @@ int comphy_update_map(struct comphy_map *serdes_map, int count) > return 0; > } > > +#define SW_SMI_CMD_R(d, r) (0x9800 | (((d) & 0x1f) << 5) | ((r) & 0x1f)) > +#define SW_SMI_CMD_W(d, r) (0x9400 | (((d) & 0x1f) << 5) | ((r) & 0x1f)) > + > +static int sw_multi_read(struct mii_dev *bus, int sw, int dev, int reg) > +{ > + bus->write(bus, sw, 0, 0, SW_SMI_CMD_R(dev, reg)); > + mdelay(5); > + return bus->read(bus, sw, 0, 1); > +} > + > +static void sw_multi_write(struct mii_dev *bus, int sw, int dev, int reg, > + u16 val) > +{ > + bus->write(bus, sw, 0, 1, val); > + bus->write(bus, sw, 0, 0, SW_SMI_CMD_W(dev, reg)); > + mdelay(5); > +} > + > +static int sw_scratch_read(struct mii_dev *bus, int sw, int reg) > +{ > + sw_multi_write(bus, sw, 0x1c, 0x1a, (reg & 0x7f) << 8); > + return sw_multi_read(bus, sw, 0x1c, 0x1a) & 0xff; > +} > + > +static void sw_led_write(struct mii_dev *bus, int sw, int port, int reg, > + u16 val) > +{ > + sw_multi_write(bus, sw, port, 0x16, 0x8000 | ((reg & 7) << 12) > + | (val & 0x7ff)); > +} > + > +static void sw_blink_leds(struct mii_dev *bus, int peridot, int topaz) > +{ > + int i, p; > + struct { > + int port; > + u16 val; > + int wait; > + } regs[] = { > + { 2, 0xef, 1 }, { 2, 0xfe, 1 }, { 2, 0x33, 0 }, > + { 4, 0xef, 1 }, { 4, 0xfe, 1 }, { 4, 0x33, 0 }, > + { 3, 0xfe, 1 }, { 3, 0xef, 1 }, { 3, 0x33, 0 }, > + { 1, 0xfe, 1 }, { 1, 0xef, 1 }, { 1, 0x33, 0 } > + }; > + > + for (i = 0; i < 12; ++i) { > + for (p = 0; p < peridot; ++p) { > + sw_led_write(bus, 0x10 + p, regs[i].port, 0, > + regs[i].val); > + sw_led_write(bus, 0x10 + p, regs[i].port + 4, 0, > + regs[i].val); > + } > + if (topaz) { > + sw_led_write(bus, 0x2, 0x10 + regs[i].port, 0, > + regs[i].val); > + } > + > + if (regs[i].wait) > + mdelay(75); > + } > +} > + > +static void check_switch_address(struct mii_dev *bus, int addr) > +{ > + if (sw_scratch_read(bus, addr, 0x70) >> 3 != addr) > + printf("Check of switch MDIO address failed for 0x%02x\n", > + addr); > +} > + > +static int sfp, pci, topaz, peridot, usb, passpci; > +static int sfp_pos, peridot_pos[3]; > +static int module_count; > + > +static int configure_peridots(struct gpio_desc *reset_gpio) > +{ > + int i, ret; > + u8 dout[MAX_MOX_MODULES]; > + > + memset(dout, 0, MAX_MOX_MODULES); > + > + /* set addresses of Peridot modules */ > + for (i = 0; i < peridot; ++i) > + dout[module_count - peridot_pos[i]] = (~i) & 3; > + > + /* > + * if there is a SFP module connected to the last Peridot module, set > + * the P10_SMODE to 1 for the Peridot module > + */ > + if (sfp) > + dout[module_count - peridot_pos[i - 1]] |= 1 << 3; > + > + dm_gpio_set_value(reset_gpio, 1); > + mdelay(10); > + > + ret = mox_do_spi(NULL, dout, module_count + 1); > + > + mdelay(10); > + dm_gpio_set_value(reset_gpio, 0); > + > + mdelay(50); > + > + return ret; > +} > + > +static int get_reset_gpio(struct gpio_desc *reset_gpio) > +{ > + int node; > + > + node = fdt_node_offset_by_compatible(gd->fdt_blob, 0, "cznic,moxtet"); > + if (node < 0) { > + printf("Cannot find Moxtet bus device node!\n"); > + return -1; > + } > + > + gpio_request_by_name_nodev(offset_to_ofnode(node), "devrst-gpio", 0, > + reset_gpio, GPIOD_IS_OUT); > + > + if (!dm_gpio_is_valid(reset_gpio)) { > + printf("Cannot find reset GPIO for Moxtet bus!\n"); > + return -1; > + } > + > + return 0; > +} > + > int last_stage_init(void) > { > int ret, i; > const u8 *topology; > - int module_count, is_sd; > + int is_sd; > + struct mii_dev *bus; > + struct gpio_desc reset_gpio = {}; > > ret = mox_get_topology(&topology, &module_count, &is_sd); > if (ret) { > @@ -278,6 +407,126 @@ int last_stage_init(void) > } > } > > + /* now check if modules are connected in supported mode */ > + > + for (i = 0; i < module_count; ++i) { > + switch (topology[i]) { > + case MOX_MODULE_SFP: > + if (sfp) { > + printf("Error: Only one SFP module is " > + "supported!\n"); This gives checkpatch warnings: WARNING: quoted string split across lines #492: FILE: board/CZ.NIC/turris_mox/turris_mox.c:417: + printf("Error: Only one SFP module is " + "supported!\n"); I don't have strong feeling here, but in general I also like the strings not being split, as its better for grepping / searching the code. BTW: Could you please change your patch subject for all those patches to reflect the architecture. Something like this: board: turris_mox: Check and configure modules -> arm: mvebu: turris_mox: Check and configure modules Thanks, Stefan > + } else if (topaz) { > + printf("Error: SFP module cannot be connected " > + "after Topaz Switch module!\n"); > + } else { > + sfp_pos = i; > + ++sfp; > + } > + break; > + case MOX_MODULE_PCI: > + if (pci) { > + printf("Error: Only one Mini-PCIe module is " > + "supported!\n"); > + } else if (usb) { > + printf("Error: Mini-PCIe module cannot come " > + "after USB 3.0 module!\n"); > + } else if (i && (i != 1 || !passpci)) { > + printf("Error: Mini-PCIe module should be the " > + "first connected module or come right " > + "after Passthrough Mini-PCIe module!\n"); > + } else { > + ++pci; > + } > + break; > + case MOX_MODULE_TOPAZ: > + if (topaz) { > + printf("Error: Only one Topaz module is " > + "supported!\n"); > + } else if (peridot >= 3) { > + printf("Error: At most two Peridot modules " > + "can come before Topaz module!\n"); > + } else { > + ++topaz; > + } > + break; > + case MOX_MODULE_PERIDOT: > + if (sfp || topaz) { > + printf("Error: Peridot module must come before " > + "SFP or Topaz module!\n"); > + } else if (peridot >= 3) { > + printf("Error: At most three Peridot modules " > + "are supported!\n"); > + } else { > + peridot_pos[peridot] = i; > + ++peridot; > + } > + break; > + case MOX_MODULE_USB3: > + if (pci) { > + printf("Error: USB 3.0 module cannot come " > + "after Mini-PCIe module!\n"); > + } else if (usb) { > + printf("Error: Only one USB 3.0 module is " > + "supported!\n"); > + } else if (i && (i != 1 || !passpci)) { > + printf("Error: USB 3.0 module should be the " > + "first connected module or come right " > + "after Passthrough Mini-PCIe module!\n"); > + } else { > + ++usb; > + } > + break; > + case MOX_MODULE_PASSPCI: > + if (passpci) { > + printf("Error: Only one Passthrough Mini-PCIe " > + "module is supported!\n"); > + } else if (i != 0) { > + printf("Error: Passthrough Mini-PCIe module " > + "should be the first connected " > + "module!\n"); > + } else { > + ++passpci; > + } > + } > + } > + > + /* now configure modules */ > + > + if (get_reset_gpio(&reset_gpio) < 0) > + return 0; > + > + if (peridot > 0) { > + if (configure_peridots(&reset_gpio) < 0) { > + printf("Cannot configure Peridot modules!\n"); > + peridot = 0; > + } > + } else { > + dm_gpio_set_value(&reset_gpio, 1); > + mdelay(50); > + dm_gpio_set_value(&reset_gpio, 0); > + mdelay(50); > + } > + > + if (peridot || topaz) { > + /* > + * now check if the addresses are set by reading Scratch & Misc > + * register 0x70 of Peridot (and potentially Topaz) modules > + */ > + > + bus = miiphy_get_dev_by_name("neta at 30000"); > + if (!bus) { > + printf("Cannot get MDIO bus device!\n"); > + } else { > + for (i = 0; i < peridot; ++i) > + check_switch_address(bus, 0x10 + i); > + > + if (topaz) > + check_switch_address(bus, 0x2); > + > + sw_blink_leds(bus, peridot, topaz); > + } > + } > + > printf("\n"); > > return 0; > Viele Grüße, Stefan -- DENX Software Engineering GmbH, Managing Director: Wolfgang Denk HRB 165235 Munich, Office: Kirchenstr.5, D-82194 Groebenzell, Germany Phone: (+49)-8142-66989-51 Fax: (+49)-8142-66989-80 Email: sr at denx.de