Add expansion card detection support. Add NAND card detection
support.

am64-sk EVM doesn't support daughtercards so let's restrict
daughtercard probing to am64-evm.

Signed-off-by: Roger Quadros <rog...@kernel.org>
---
 board/ti/am64x/evm.c | 177 +++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 177 insertions(+)

diff --git a/board/ti/am64x/evm.c b/board/ti/am64x/evm.c
index 42795cbd22..a7ddee9d64 100644
--- a/board/ti/am64x/evm.c
+++ b/board/ti/am64x/evm.c
@@ -11,8 +11,10 @@
 #include <asm/io.h>
 #include <dm/uclass.h>
 #include <k3-ddrss.h>
+#include <net.h>
 #include <spl.h>
 #include <fdt_support.h>
+#include <asm/gpio.h>
 #include <asm/arch/hardware.h>
 #include <env.h>
 
@@ -24,6 +26,17 @@
 #define board_is_am64x_skevm() (board_ti_k3_is("AM64-SKEVM") || \
                                board_ti_k3_is("AM64B-SKEVM"))
 
+#define AM64X_MAX_DAUGHTER_CARDS       8
+
+/* Daughter card presence detection signals */
+enum {
+       AM64X_EVM_HSE_BRD_DET,
+       AM64X_EVM_BRD_DET_COUNT,
+};
+
+/* Max number of MAC addresses that are parsed/processed per daughter card */
+#define DAUGHTER_CARD_NO_OF_MAC_ADDR   8
+
 DECLARE_GLOBAL_DATA_PTR;
 
 int board_init(void)
@@ -219,10 +232,170 @@ static void setup_serial(void)
        snprintf(serial_string, sizeof(serial_string), "%016lx", board_serial);
        env_set("serial#", serial_string);
 }
+
 #endif
 #endif
 
 #ifdef CONFIG_BOARD_LATE_INIT
+static const char *k3_dtbo_list[AM64X_MAX_DAUGHTER_CARDS] = {NULL};
+
+static int init_daughtercard_det_gpio(char *gpio_name, struct gpio_desc *desc)
+{
+       int ret;
+
+       memset(desc, 0, sizeof(*desc));
+
+       ret = dm_gpio_lookup_name(gpio_name, desc);
+       if (ret < 0) {
+               pr_err("Failed to lookup gpio %s: %d\n", gpio_name, ret);
+               return ret;
+       }
+
+       /* Request GPIO, simply re-using the name as label */
+       ret = dm_gpio_request(desc, gpio_name);
+       if (ret < 0) {
+               pr_err("Failed to request gpio %s: %d\n", gpio_name, ret);
+               return ret;
+       }
+
+       return dm_gpio_set_dir_flags(desc, GPIOD_IS_IN);
+}
+
+static int probe_daughtercards(void)
+{
+       struct ti_am6_eeprom ep;
+       struct gpio_desc board_det_gpios[AM64X_EVM_BRD_DET_COUNT];
+       char mac_addr[DAUGHTER_CARD_NO_OF_MAC_ADDR][TI_EEPROM_HDR_ETH_ALEN];
+       u8 mac_addr_cnt;
+       char name_overlays[1024] = { 0 };
+       int i, nb_dtbos = 0;
+       int ret;
+
+       /*
+        * Daughter card presence detection signal name to GPIO (via I2C I/O
+        * expander @ address 0x38) name and EEPROM I2C address mapping.
+        */
+       const struct {
+               char *gpio_name;
+               u8 i2c_addr;
+       } slot_map[AM64X_EVM_BRD_DET_COUNT] = {
+               { "gpio@38_0", 0x52, }, /* AM64X_EVM_HSE_BRD_DET */
+       };
+
+       /* Declaration of daughtercards to probe */
+       const struct {
+               u8 slot_index;          /* Slot the card is installed */
+               char *card_name;        /* EEPROM-programmed card name */
+               char *dtbo_name;        /* Device tree overlay to apply */
+               u8 eth_offset;          /* ethXaddr MAC address index offset */
+       } cards[] = {
+               {
+                       AM64X_EVM_HSE_BRD_DET,
+                       "TMDS64DC02EVM",
+                       "k3-am642-evm-nand.dtbo",
+                       0,
+               },
+       };
+
+       /*
+        * Initialize GPIO used for daughtercard slot presence detection and
+        * keep the resulting handles in local array for easier access.
+        */
+       for (i = 0; i < AM64X_EVM_BRD_DET_COUNT; i++) {
+               ret = init_daughtercard_det_gpio(slot_map[i].gpio_name,
+                                                &board_det_gpios[i]);
+               if (ret < 0)
+                       return ret;
+       }
+
+       memset(k3_dtbo_list, 0, sizeof(k3_dtbo_list));
+       for (i = 0; i < ARRAY_SIZE(cards); i++) {
+               /* Obtain card-specific slot index and associated I2C address */
+               u8 slot_index = cards[i].slot_index;
+               u8 i2c_addr = slot_map[slot_index].i2c_addr;
+               const char *dtboname;
+
+               /*
+                * The presence detection signal is active-low, hence skip
+                * over this card slot if anything other than 0 is returned.
+                */
+               ret = dm_gpio_get_value(&board_det_gpios[slot_index]);
+               if (ret < 0)
+                       return ret;
+               else if (ret)
+                       continue;
+
+               /* Get and parse the daughter card EEPROM record */
+               ret = ti_i2c_eeprom_am6_get(CONFIG_EEPROM_BUS_ADDRESS, i2c_addr,
+                                           &ep,
+                                           (char **)mac_addr,
+                                           DAUGHTER_CARD_NO_OF_MAC_ADDR,
+                                           &mac_addr_cnt);
+               if (ret) {
+                       pr_err("Reading daughtercard EEPROM at 0x%02x failed 
%d\n",
+                              i2c_addr, ret);
+                       /*
+                        * Even this is pretty serious let's just skip over
+                        * this particular daughtercard, rather than ending
+                        * the probing process altogether.
+                        */
+                       continue;
+               }
+
+               /* Only process the parsed data if we found a match */
+               if (strncmp(ep.name, cards[i].card_name, sizeof(ep.name)))
+                       continue;
+
+               printf("Detected: %s rev %s\n", ep.name, ep.version);
+
+#ifndef CONFIG_SPL_BUILD
+               int j;
+               /*
+                * Populate any MAC addresses from daughtercard into the U-Boot
+                * environment, starting with a card-specific offset so we can
+                * have multiple cards contribute to the MAC pool in a well-
+                * defined manner.
+                */
+               for (j = 0; j < mac_addr_cnt; j++) {
+                       if (!is_valid_ethaddr((u8 *)mac_addr[j]))
+                               continue;
+
+                       eth_env_set_enetaddr_by_index("eth",
+                                                     cards[i].eth_offset + j,
+                                                     (uchar *)mac_addr[j]);
+               }
+#endif
+
+               /* Skip if no overlays are to be added */
+               if (!strlen(cards[i].dtbo_name))
+                       continue;
+
+               dtboname = cards[i].dtbo_name;
+               k3_dtbo_list[nb_dtbos++] = dtboname;
+
+               /*
+                * Make sure we are not running out of buffer space by checking
+                * if we can fit the new overlay, a trailing space to be used
+                * as a separator, plus the terminating zero.
+                */
+               if (strlen(name_overlays) + strlen(dtboname) + 2 >
+                   sizeof(name_overlays))
+                       return -ENOMEM;
+
+               /* Append to our list of overlays */
+               strcat(name_overlays, dtboname);
+               strcat(name_overlays, " ");
+       }
+
+#ifndef CONFIG_SPL_BUILD
+       /* Apply device tree overlay(s) to the U-Boot environment, if any */
+       if (strlen(name_overlays))
+               return env_set("name_overlays", name_overlays);
+#endif
+
+       return 0;
+}
+
 int board_late_init(void)
 {
        if (IS_ENABLED(CONFIG_TI_I2C_BOARD_DETECT)) {
@@ -237,6 +410,10 @@ int board_late_init(void)
                 * an index of 1.
                 */
                board_ti_am6_set_ethaddr(1, ep->mac_addr_cnt);
+
+               /* Check for and probe any plugged-in daughtercards */
+               if (board_is_am64x_evm())
+                       probe_daughtercards();
        }
 
        return 0;
-- 
2.34.1

Reply via email to