drivers/net/dsa/microchip/ksz8795_spi.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Microchip KSZ8795 series register access through SPI
   4  *
   5  * Copyright (C) 2017 Microchip Technology Inc.
   6  *      Tristram Ha <[email protected]>
   7  */
   8
   9 #include <asm/unaligned.h>
  10
  11 #include <linux/delay.h>
  12 #include <linux/kernel.h>
  13 #include <linux/module.h>
  14 #include <linux/regmap.h>
  15 #include <linux/spi/spi.h>
  16
  17 #include "ksz8.h"
  18 #include "ksz_common.h"
  19
  20 #define KSZ8795_SPI_ADDR_SHIFT                  12
  21 #define KSZ8795_SPI_ADDR_ALIGN                  3
  22 #define KSZ8795_SPI_TURNAROUND_SHIFT            1
  23
  24 #define KSZ8863_SPI_ADDR_SHIFT                  8
  25 #define KSZ8863_SPI_ADDR_ALIGN                  8
  26 #define KSZ8863_SPI_TURNAROUND_SHIFT            0
  27
  28 KSZ_REGMAP_TABLE(ksz8795, 16, KSZ8795_SPI_ADDR_SHIFT,
  29                  KSZ8795_SPI_TURNAROUND_SHIFT, KSZ8795_SPI_ADDR_ALIGN);
  30
  31 KSZ_REGMAP_TABLE(ksz8863, 16, KSZ8863_SPI_ADDR_SHIFT,
  32                  KSZ8863_SPI_TURNAROUND_SHIFT, KSZ8863_SPI_ADDR_ALIGN);
  33
  34 static int ksz8795_spi_probe(struct spi_device *spi)
  35 {
  36         const struct regmap_config *regmap_config;
  37         struct device *ddev = &spi->dev;
  38         struct regmap_config rc;
  39         struct ksz_device *dev;
  40         struct ksz8 *ksz8;
  41         int i, ret = 0;
  42
  43         ksz8 = devm_kzalloc(&spi->dev, sizeof(struct ksz8), GFP_KERNEL);
  44         ksz8->priv = spi;
  45
  46         dev = ksz_switch_alloc(&spi->dev, ksz8);
  47         if (!dev)
  48                 return -ENOMEM;
  49
  50         regmap_config = device_get_match_data(ddev);
  51         if (!regmap_config)
  52                 return -EINVAL;
  53
  54         for (i = 0; i < ARRAY_SIZE(ksz8795_regmap_config); i++) {
  55                 rc = regmap_config[i];
  56                 rc.lock_arg = &dev->regmap_mutex;
  57                 dev->regmap[i] = devm_regmap_init_spi(spi, &rc);
  58                 if (IS_ERR(dev->regmap[i])) {
  59                         ret = PTR_ERR(dev->regmap[i]);
  60                         dev_err(&spi->dev,
  61                                 "Failed to initialize regmap%i: %d\n",
  62                                 regmap_config[i].val_bits, ret);
  63                         return ret;
  64                 }
  65         }
  66
  67         if (spi->dev.platform_data)
  68                 dev->pdata = spi->dev.platform_data;
  69
  70         /* setup spi */
  71         spi->mode = SPI_MODE_3;
  72         ret = spi_setup(spi);
  73         if (ret)
  74                 return ret;
  75
  76         ret = ksz8_switch_register(dev);
  77
  78         /* Main DSA driver may not be started yet. */
  79         if (ret)
  80                 return ret;
  81
  82         spi_set_drvdata(spi, dev);
  83
  84         return 0;
  85 }
  86
  87 static int ksz8795_spi_remove(struct spi_device *spi)
  88 {
  89         struct ksz_device *dev = spi_get_drvdata(spi);
  90
  91         if (dev)
  92                 ksz_switch_remove(dev);
  93
  94         return 0;
  95 }
  96
  97 static void ksz8795_spi_shutdown(struct spi_device *spi)
  98 {
  99         struct ksz_device *dev = spi_get_drvdata(spi);
 100
 101         if (dev && dev->dev_ops->shutdown)
 102                 dev->dev_ops->shutdown(dev);
 103 }
 104
 105 static const struct of_device_id ksz8795_dt_ids[] = {
 106         { .compatible = "microchip,ksz8765", .data = &ksz8795_regmap_config },
 107         { .compatible = "microchip,ksz8794", .data = &ksz8795_regmap_config },
 108         { .compatible = "microchip,ksz8795", .data = &ksz8795_regmap_config },
 109         { .compatible = "microchip,ksz8863", .data = &ksz8863_regmap_config },
 110         { .compatible = "microchip,ksz8873", .data = &ksz8863_regmap_config },
 111         {},
 112 };
 113 MODULE_DEVICE_TABLE(of, ksz8795_dt_ids);
 114
 115 static struct spi_driver ksz8795_spi_driver = {
 116         .driver = {
 117                 .name   = "ksz8795-switch",
 118                 .owner  = THIS_MODULE,
 119                 .of_match_table = of_match_ptr(ksz8795_dt_ids),
 120         },
 121         .probe  = ksz8795_spi_probe,
 122         .remove = ksz8795_spi_remove,
 123         .shutdown = ksz8795_spi_shutdown,
 124 };
 125
 126 module_spi_driver(ksz8795_spi_driver);
 127
 128 MODULE_AUTHOR("Tristram Ha <[email protected]>");
 129 MODULE_DESCRIPTION("Microchip KSZ8795 Series Switch SPI Driver");
 130 MODULE_LICENSE("GPL");