drivers/phy/marvell/comphy_core.c

   1 /*
   2  * Copyright (C) 2015-2016 Marvell International Ltd.
   3  *
   4  * Copyright (C) 2016 Stefan Roese <sr@denx.de>
   5  *
   6  * SPDX-License-Identifier:     GPL-2.0+
   7  */
   8
   9 #include <common.h>
  10 #include <dm.h>
  11 #include <fdtdec.h>
  12 #include <linux/errno.h>
  13 #include <asm/io.h>
  14
  15 #include "comphy.h"
  16
  17 #define COMPHY_MAX_CHIP 4
  18
  19 DECLARE_GLOBAL_DATA_PTR;
  20
  21 static char *get_speed_string(u32 speed)
  22 {
  23         char *speed_strings[] = {"1.25 Gbps", "1.5 Gbps", "2.5 Gbps",
  24                                  "3.0 Gbps", "3.125 Gbps", "5 Gbps", "6 Gbps",
  25                                  "6.25 Gbps", "10.31 Gbps" };
  26
  27         if (speed < 0 || speed > PHY_SPEED_MAX)
  28                 return "invalid";
  29
  30         return speed_strings[speed];
  31 }
  32
  33 static char *get_type_string(u32 type)
  34 {
  35         char *type_strings[] = {"UNCONNECTED", "PEX0", "PEX1", "PEX2", "PEX3",
  36                                 "SATA0", "SATA1", "SATA2", "SATA3", "SGMII0",
  37                                 "SGMII1", "SGMII2", "SGMII3", "QSGMII",
  38                                 "USB3_HOST0", "USB3_HOST1", "USB3_DEVICE",
  39                                 "XAUI0", "XAUI1", "XAUI2", "XAUI3",
  40                                 "RXAUI0", "RXAUI1", "KR"};
  41
  42         if (type < 0 || type > PHY_TYPE_MAX)
  43                 return "invalid";
  44
  45         return type_strings[type];
  46 }
  47
  48 void reg_set(void __iomem *addr, u32 data, u32 mask)
  49 {
  50         debug("Write to address = %#010lx, data = %#010x (mask = %#010x) - ",
  51               (unsigned long)addr, data, mask);
  52         debug("old value = %#010x ==> ", readl(addr));
  53         reg_set_silent(addr, data, mask);
  54         debug("new value %#010x\n", readl(addr));
  55 }
  56
  57 void reg_set_silent(void __iomem *addr, u32 data, u32 mask)
  58 {
  59         u32 reg_data;
  60
  61         reg_data = readl(addr);
  62         reg_data &= ~mask;
  63         reg_data |= data;
  64         writel(reg_data, addr);
  65 }
  66
  67 void reg_set16(void __iomem *addr, u16 data, u16 mask)
  68 {
  69         debug("Write to address = %#010lx, data = %#06x (mask = %#06x) - ",
  70               (unsigned long)addr, data, mask);
  71         debug("old value = %#06x ==> ", readw(addr));
  72         reg_set_silent16(addr, data, mask);
  73         debug("new value %#06x\n", readw(addr));
  74 }
  75
  76 void reg_set_silent16(void __iomem *addr, u16 data, u16 mask)
  77 {
  78         u16 reg_data;
  79
  80         reg_data = readw(addr);
  81         reg_data &= ~mask;
  82         reg_data |= data;
  83         writew(reg_data, addr);
  84 }
  85
  86 void comphy_print(struct chip_serdes_phy_config *chip_cfg,
  87                   struct comphy_map *comphy_map_data)
  88 {
  89         u32 lane;
  90
  91         for (lane = 0; lane < chip_cfg->comphy_lanes_count;
  92              lane++, comphy_map_data++) {
  93                 if (comphy_map_data->type == PHY_TYPE_UNCONNECTED)
  94                         continue;
  95
  96                 if (comphy_map_data->speed == PHY_SPEED_INVALID) {
  97                         printf("Comphy-%d: %-13s\n", lane,
  98                                get_type_string(comphy_map_data->type));
  99                 } else {
 100                         printf("Comphy-%d: %-13s %-10s\n", lane,
 101                                get_type_string(comphy_map_data->type),
 102                                get_speed_string(comphy_map_data->speed));
 103                 }
 104         }
 105 }
 106
 107 static int comphy_probe(struct udevice *dev)
 108 {
 109         const void *blob = gd->fdt_blob;
 110         int node = dev->of_offset;
 111         struct chip_serdes_phy_config *chip_cfg = dev_get_priv(dev);
 112         struct comphy_map comphy_map_data[MAX_LANE_OPTIONS];
 113         int subnode;
 114         int lane;
 115
 116         /* Save base addresses for later use */
 117         chip_cfg->comphy_base_addr = (void *)dev_get_addr_index(dev, 0);
 118         if (IS_ERR(chip_cfg->comphy_base_addr))
 119                 return PTR_ERR(chip_cfg->comphy_base_addr);
 120
 121         chip_cfg->hpipe3_base_addr = (void *)dev_get_addr_index(dev, 1);
 122         if (IS_ERR(chip_cfg->hpipe3_base_addr))
 123                 return PTR_ERR(chip_cfg->hpipe3_base_addr);
 124
 125         chip_cfg->comphy_lanes_count = fdtdec_get_int(blob, node,
 126                                                       "max-lanes", 0);
 127         if (chip_cfg->comphy_lanes_count <= 0) {
 128                 dev_err(&dev->dev, "comphy max lanes is wrong\n");
 129                 return -EINVAL;
 130         }
 131
 132         chip_cfg->comphy_mux_bitcount = fdtdec_get_int(blob, node,
 133                                                        "mux-bitcount", 0);
 134         if (chip_cfg->comphy_mux_bitcount <= 0) {
 135                 dev_err(&dev->dev, "comphy mux bit count is wrong\n");
 136                 return -EINVAL;
 137         }
 138
 139         if (of_device_is_compatible(dev, "marvell,comphy-armada-3700"))
 140                 chip_cfg->ptr_comphy_chip_init = comphy_a3700_init;
 141
 142         /*
 143          * Bail out if no chip_init function is defined, e.g. no
 144          * compatible node is found
 145          */
 146         if (!chip_cfg->ptr_comphy_chip_init) {
 147                 dev_err(&dev->dev, "comphy: No compatible DT node found\n");
 148                 return -ENODEV;
 149         }
 150
 151         lane = 0;
 152         fdt_for_each_subnode(blob, subnode, node) {
 153                 /* Skip disabled ports */
 154                 if (!fdtdec_get_is_enabled(blob, subnode))
 155                         continue;
 156
 157                 comphy_map_data[lane].speed = fdtdec_get_int(
 158                         blob, subnode, "phy-speed", PHY_TYPE_INVALID);
 159                 comphy_map_data[lane].type = fdtdec_get_int(
 160                         blob, subnode, "phy-type", PHY_SPEED_INVALID);
 161                 comphy_map_data[lane].invert = fdtdec_get_int(
 162                         blob, subnode, "phy-invert", PHY_POLARITY_NO_INVERT);
 163                 comphy_map_data[lane].clk_src = fdtdec_get_bool(blob, subnode,
 164                                                                 "clk-src");
 165                 if (comphy_map_data[lane].type == PHY_TYPE_INVALID) {
 166                         printf("no phy type for lane %d, setting lane as unconnected\n",
 167                                lane + 1);
 168                 }
 169
 170                 lane++;
 171         }
 172
 173         /* Save comphy index for MultiCP devices (A8K) */
 174         chip_cfg->comphy_index = dev->seq;
 175         /* PHY power UP sequence */
 176         chip_cfg->ptr_comphy_chip_init(chip_cfg, comphy_map_data);
 177         /* PHY print SerDes status */
 178         comphy_print(chip_cfg, comphy_map_data);
 179
 180         /* Initialize dedicated PHYs (not muxed SerDes lanes) */
 181         comphy_dedicated_phys_init();
 182
 183         return 0;
 184 }
 185
 186 static const struct udevice_id comphy_ids[] = {
 187         { .compatible = "marvell,mvebu-comphy" },
 188         { }
 189 };
 190
 191 U_BOOT_DRIVER(mvebu_comphy) = {
 192         .name   = "mvebu_comphy",
 193         .id     = UCLASS_MISC,
 194         .of_match = comphy_ids,
 195         .probe  = comphy_probe,
 196         .priv_auto_alloc_size = sizeof(struct chip_serdes_phy_config),
 197 };