This should be done in the device driver instead of the device tree. Signed-off-by: Christian Eggers <ceggers@arri.de> Signed-off-by: Jakub Kicinski <kuba@kernel.org>
		
			
				
	
	
		
			119 lines
		
	
	
		
			2.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			119 lines
		
	
	
		
			2.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0
 | |
| /*
 | |
|  * Microchip KSZ9477 series register access through SPI
 | |
|  *
 | |
|  * Copyright (C) 2017-2019 Microchip Technology Inc.
 | |
|  */
 | |
| 
 | |
| #include <asm/unaligned.h>
 | |
| 
 | |
| #include <linux/delay.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/regmap.h>
 | |
| #include <linux/spi/spi.h>
 | |
| 
 | |
| #include "ksz_common.h"
 | |
| 
 | |
| #define SPI_ADDR_SHIFT			24
 | |
| #define SPI_ADDR_ALIGN			3
 | |
| #define SPI_TURNAROUND_SHIFT		5
 | |
| 
 | |
| KSZ_REGMAP_TABLE(ksz9477, 32, SPI_ADDR_SHIFT,
 | |
| 		 SPI_TURNAROUND_SHIFT, SPI_ADDR_ALIGN);
 | |
| 
 | |
| static int ksz9477_spi_probe(struct spi_device *spi)
 | |
| {
 | |
| 	struct regmap_config rc;
 | |
| 	struct ksz_device *dev;
 | |
| 	int i, ret;
 | |
| 
 | |
| 	dev = ksz_switch_alloc(&spi->dev, spi);
 | |
| 	if (!dev)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	for (i = 0; i < ARRAY_SIZE(ksz9477_regmap_config); i++) {
 | |
| 		rc = ksz9477_regmap_config[i];
 | |
| 		rc.lock_arg = &dev->regmap_mutex;
 | |
| 		dev->regmap[i] = devm_regmap_init_spi(spi, &rc);
 | |
| 		if (IS_ERR(dev->regmap[i])) {
 | |
| 			ret = PTR_ERR(dev->regmap[i]);
 | |
| 			dev_err(&spi->dev,
 | |
| 				"Failed to initialize regmap%i: %d\n",
 | |
| 				ksz9477_regmap_config[i].val_bits, ret);
 | |
| 			return ret;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	if (spi->dev.platform_data)
 | |
| 		dev->pdata = spi->dev.platform_data;
 | |
| 
 | |
| 	/* setup spi */
 | |
| 	spi->mode = SPI_MODE_3;
 | |
| 	ret = spi_setup(spi);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	ret = ksz9477_switch_register(dev);
 | |
| 
 | |
| 	/* Main DSA driver may not be started yet. */
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	spi_set_drvdata(spi, dev);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int ksz9477_spi_remove(struct spi_device *spi)
 | |
| {
 | |
| 	struct ksz_device *dev = spi_get_drvdata(spi);
 | |
| 
 | |
| 	if (dev)
 | |
| 		ksz_switch_remove(dev);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void ksz9477_spi_shutdown(struct spi_device *spi)
 | |
| {
 | |
| 	struct ksz_device *dev = spi_get_drvdata(spi);
 | |
| 
 | |
| 	if (dev && dev->dev_ops->shutdown)
 | |
| 		dev->dev_ops->shutdown(dev);
 | |
| }
 | |
| 
 | |
| static const struct of_device_id ksz9477_dt_ids[] = {
 | |
| 	{ .compatible = "microchip,ksz9477" },
 | |
| 	{ .compatible = "microchip,ksz9897" },
 | |
| 	{ .compatible = "microchip,ksz9893" },
 | |
| 	{ .compatible = "microchip,ksz9563" },
 | |
| 	{ .compatible = "microchip,ksz8563" },
 | |
| 	{ .compatible = "microchip,ksz9567" },
 | |
| 	{},
 | |
| };
 | |
| MODULE_DEVICE_TABLE(of, ksz9477_dt_ids);
 | |
| 
 | |
| static struct spi_driver ksz9477_spi_driver = {
 | |
| 	.driver = {
 | |
| 		.name	= "ksz9477-switch",
 | |
| 		.owner	= THIS_MODULE,
 | |
| 		.of_match_table = of_match_ptr(ksz9477_dt_ids),
 | |
| 	},
 | |
| 	.probe	= ksz9477_spi_probe,
 | |
| 	.remove	= ksz9477_spi_remove,
 | |
| 	.shutdown = ksz9477_spi_shutdown,
 | |
| };
 | |
| 
 | |
| module_spi_driver(ksz9477_spi_driver);
 | |
| 
 | |
| MODULE_ALIAS("spi:ksz9477");
 | |
| MODULE_ALIAS("spi:ksz9897");
 | |
| MODULE_ALIAS("spi:ksz9893");
 | |
| MODULE_ALIAS("spi:ksz9563");
 | |
| MODULE_ALIAS("spi:ksz8563");
 | |
| MODULE_ALIAS("spi:ksz9567");
 | |
| MODULE_AUTHOR("Woojung Huh <Woojung.Huh@microchip.com>");
 | |
| MODULE_DESCRIPTION("Microchip KSZ9477 Series Switch SPI access Driver");
 | |
| MODULE_LICENSE("GPL");
 |