| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451 | // SPDX-License-Identifier: GPL-2.0+/* * Copyright (c) 2014 Google, Inc */#include <common.h>#include <dm.h>#include <errno.h>#include <malloc.h>#include <spi.h>#include <dm/device-internal.h>#include <dm/uclass-internal.h>#include <dm/lists.h>#include <dm/util.h>DECLARE_GLOBAL_DATA_PTR;static int spi_set_speed_mode(struct udevice *bus, int speed, int mode){	struct dm_spi_ops *ops;	int ret;	ops = spi_get_ops(bus);	if (ops->set_speed)		ret = ops->set_speed(bus, speed);	else		ret = -EINVAL;	if (ret) {		printf("Cannot set speed (err=%d)\n", ret);		return ret;	}	if (ops->set_mode)		ret = ops->set_mode(bus, mode);	else		ret = -EINVAL;	if (ret) {		printf("Cannot set mode (err=%d)\n", ret);		return ret;	}	return 0;}int dm_spi_claim_bus(struct udevice *dev){	struct udevice *bus = dev->parent;	struct dm_spi_ops *ops = spi_get_ops(bus);	struct dm_spi_bus *spi = dev_get_uclass_priv(bus);	struct spi_slave *slave = dev_get_parent_priv(dev);	int speed;	speed = slave->max_hz;	if (spi->max_hz) {		if (speed)			speed = min(speed, (int)spi->max_hz);		else			speed = spi->max_hz;	}	if (!speed)		speed = 100000;	if (speed != slave->speed) {		int ret = spi_set_speed_mode(bus, speed, slave->mode);		if (ret)			return ret;		slave->speed = speed;	}	return ops->claim_bus ? ops->claim_bus(dev) : 0;}void dm_spi_release_bus(struct udevice *dev){	struct udevice *bus = dev->parent;	struct dm_spi_ops *ops = spi_get_ops(bus);	if (ops->release_bus)		ops->release_bus(dev);}int dm_spi_xfer(struct udevice *dev, unsigned int bitlen,		const void *dout, void *din, unsigned long flags){	struct udevice *bus = dev->parent;	if (bus->uclass->uc_drv->id != UCLASS_SPI)		return -EOPNOTSUPP;	return spi_get_ops(bus)->xfer(dev, bitlen, dout, din, flags);}int spi_claim_bus(struct spi_slave *slave){	return dm_spi_claim_bus(slave->dev);}void spi_release_bus(struct spi_slave *slave){	dm_spi_release_bus(slave->dev);}int spi_xfer(struct spi_slave *slave, unsigned int bitlen,	     const void *dout, void *din, unsigned long flags){	return dm_spi_xfer(slave->dev, bitlen, dout, din, flags);}#if !CONFIG_IS_ENABLED(OF_PLATDATA)static int spi_child_post_bind(struct udevice *dev){	struct dm_spi_slave_platdata *plat = dev_get_parent_platdata(dev);	if (!dev_of_valid(dev))		return 0;	return spi_slave_ofdata_to_platdata(dev, plat);}#endifstatic int spi_post_probe(struct udevice *bus){#if !CONFIG_IS_ENABLED(OF_PLATDATA)	struct dm_spi_bus *spi = dev_get_uclass_priv(bus);	spi->max_hz = dev_read_u32_default(bus, "spi-max-frequency", 0);#endif#if defined(CONFIG_NEEDS_MANUAL_RELOC)	struct dm_spi_ops *ops = spi_get_ops(bus);	if (ops->claim_bus)		ops->claim_bus += gd->reloc_off;	if (ops->release_bus)		ops->release_bus += gd->reloc_off;	if (ops->set_wordlen)		ops->set_wordlen += gd->reloc_off;	if (ops->xfer)		ops->xfer += gd->reloc_off;	if (ops->set_speed)		ops->set_speed += gd->reloc_off;	if (ops->set_mode)		ops->set_mode += gd->reloc_off;	if (ops->cs_info)		ops->cs_info += gd->reloc_off;#endif	return 0;}static int spi_child_pre_probe(struct udevice *dev){	struct dm_spi_slave_platdata *plat = dev_get_parent_platdata(dev);	struct spi_slave *slave = dev_get_parent_priv(dev);	/*	 * This is needed because we pass struct spi_slave around the place	 * instead slave->dev (a struct udevice). So we have to have some	 * way to access the slave udevice given struct spi_slave. Once we	 * change the SPI API to use udevice instead of spi_slave, we can	 * drop this.	 */	slave->dev = dev;	slave->max_hz = plat->max_hz;	slave->mode = plat->mode;	slave->wordlen = SPI_DEFAULT_WORDLEN;	return 0;}int spi_chip_select(struct udevice *dev){	struct dm_spi_slave_platdata *plat = dev_get_parent_platdata(dev);	return plat ? plat->cs : -ENOENT;}int spi_find_chip_select(struct udevice *bus, int cs, struct udevice **devp){	struct udevice *dev;	for (device_find_first_child(bus, &dev); dev;	     device_find_next_child(&dev)) {		struct dm_spi_slave_platdata *plat;		plat = dev_get_parent_platdata(dev);		debug("%s: plat=%p, cs=%d\n", __func__, plat, plat->cs);		if (plat->cs == cs) {			*devp = dev;			return 0;		}	}	return -ENODEV;}int spi_cs_is_valid(unsigned int busnum, unsigned int cs){	struct spi_cs_info info;	struct udevice *bus;	int ret;	ret = uclass_find_device_by_seq(UCLASS_SPI, busnum, false, &bus);	if (ret) {		debug("%s: No bus %d\n", __func__, busnum);		return ret;	}	return spi_cs_info(bus, cs, &info);}int spi_cs_info(struct udevice *bus, uint cs, struct spi_cs_info *info){	struct spi_cs_info local_info;	struct dm_spi_ops *ops;	int ret;	if (!info)		info = &local_info;	/* If there is a device attached, return it */	info->dev = NULL;	ret = spi_find_chip_select(bus, cs, &info->dev);	if (!ret)		return 0;	/*	 * Otherwise ask the driver. For the moment we don't have CS info.	 * When we do we could provide the driver with a helper function	 * to figure out what chip selects are valid, or just handle the	 * request.	 */	ops = spi_get_ops(bus);	if (ops->cs_info)		return ops->cs_info(bus, cs, info);	/*	 * We could assume there is at least one valid chip select, but best	 * to be sure and return an error in this case. The driver didn't	 * care enough to tell us.	 */	return -ENODEV;}int spi_find_bus_and_cs(int busnum, int cs, struct udevice **busp,			struct udevice **devp){	struct udevice *bus, *dev;	int ret;	ret = uclass_find_device_by_seq(UCLASS_SPI, busnum, false, &bus);	if (ret) {		debug("%s: No bus %d\n", __func__, busnum);		return ret;	}	ret = spi_find_chip_select(bus, cs, &dev);	if (ret) {		debug("%s: No cs %d\n", __func__, cs);		return ret;	}	*busp = bus;	*devp = dev;	return ret;}int spi_get_bus_and_cs(int busnum, int cs, int speed, int mode,		       const char *drv_name, const char *dev_name,		       struct udevice **busp, struct spi_slave **devp){	struct udevice *bus, *dev;	struct dm_spi_slave_platdata *plat;	bool created = false;	int ret;#if CONFIG_IS_ENABLED(OF_PLATDATA)	ret = uclass_first_device_err(UCLASS_SPI, &bus);#else	ret = uclass_get_device_by_seq(UCLASS_SPI, busnum, &bus);#endif	if (ret) {		printf("Invalid bus %d (err=%d)\n", busnum, ret);		return ret;	}	ret = spi_find_chip_select(bus, cs, &dev);	/*	 * If there is no such device, create one automatically. This means	 * that we don't need a device tree node or platform data for the	 * SPI flash chip - we will bind to the correct driver.	 */	if (ret == -ENODEV && drv_name) {		debug("%s: Binding new device '%s', busnum=%d, cs=%d, driver=%s\n",		      __func__, dev_name, busnum, cs, drv_name);		ret = device_bind_driver(bus, drv_name, dev_name, &dev);		if (ret) {			debug("%s: Unable to bind driver (ret=%d)\n", __func__,			      ret);			return ret;		}		plat = dev_get_parent_platdata(dev);		plat->cs = cs;		plat->max_hz = speed;		plat->mode = mode;		created = true;	} else if (ret) {		printf("Invalid chip select %d:%d (err=%d)\n", busnum, cs,		       ret);		return ret;	}	if (!device_active(dev)) {		struct spi_slave *slave;		ret = device_probe(dev);		if (ret)			goto err;		slave = dev_get_parent_priv(dev);		slave->dev = dev;	}	plat = dev_get_parent_platdata(dev);	if (!speed) {		speed = plat->max_hz;		mode = plat->mode;	}	ret = spi_set_speed_mode(bus, speed, mode);	if (ret)		goto err;	*busp = bus;	*devp = dev_get_parent_priv(dev);	debug("%s: bus=%p, slave=%p\n", __func__, bus, *devp);	return 0;err:	debug("%s: Error path, created=%d, device '%s'\n", __func__,	      created, dev->name);	if (created) {		device_remove(dev, DM_REMOVE_NORMAL);		device_unbind(dev);	}	return ret;}/* Compatibility function - to be removed */struct spi_slave *spi_setup_slave(unsigned int busnum, unsigned int cs,				  unsigned int speed, unsigned int mode){	struct spi_slave *slave;	struct udevice *dev;	int ret;	ret = spi_get_bus_and_cs(busnum, cs, speed, mode, NULL, 0, &dev,				 &slave);	if (ret)		return NULL;	return slave;}void spi_free_slave(struct spi_slave *slave){	device_remove(slave->dev, DM_REMOVE_NORMAL);	slave->dev = NULL;}int spi_slave_ofdata_to_platdata(struct udevice *dev,				 struct dm_spi_slave_platdata *plat){	int mode = 0;	int value;	plat->cs = dev_read_u32_default(dev, "reg", -1);	plat->max_hz = dev_read_u32_default(dev, "spi-max-frequency", 0);	if (dev_read_bool(dev, "spi-cpol"))		mode |= SPI_CPOL;	if (dev_read_bool(dev, "spi-cpha"))		mode |= SPI_CPHA;	if (dev_read_bool(dev, "spi-cs-high"))		mode |= SPI_CS_HIGH;	if (dev_read_bool(dev, "spi-3wire"))		mode |= SPI_3WIRE;	if (dev_read_bool(dev, "spi-half-duplex"))		mode |= SPI_PREAMBLE;	/* Device DUAL/QUAD mode */	value = dev_read_u32_default(dev, "spi-tx-bus-width", 1);	switch (value) {	case 1:		break;	case 2:		mode |= SPI_TX_DUAL;		break;	case 4:		mode |= SPI_TX_QUAD;		break;	default:		warn_non_spl("spi-tx-bus-width %d not supported\n", value);		break;	}	value = dev_read_u32_default(dev, "spi-rx-bus-width", 1);	switch (value) {	case 1:		break;	case 2:		mode |= SPI_RX_DUAL;		break;	case 4:		mode |= SPI_RX_QUAD;		break;	default:		warn_non_spl("spi-rx-bus-width %d not supported\n", value);		break;	}	plat->mode = mode;	return 0;}UCLASS_DRIVER(spi) = {	.id		= UCLASS_SPI,	.name		= "spi",	.flags		= DM_UC_FLAG_SEQ_ALIAS,#if !CONFIG_IS_ENABLED(OF_PLATDATA)	.post_bind	= dm_scan_fdt_dev,#endif	.post_probe	= spi_post_probe,	.child_pre_probe = spi_child_pre_probe,	.per_device_auto_alloc_size = sizeof(struct dm_spi_bus),	.per_child_auto_alloc_size = sizeof(struct spi_slave),	.per_child_platdata_auto_alloc_size =			sizeof(struct dm_spi_slave_platdata),#if !CONFIG_IS_ENABLED(OF_PLATDATA)	.child_post_bind = spi_child_post_bind,#endif};UCLASS_DRIVER(spi_generic) = {	.id		= UCLASS_SPI_GENERIC,	.name		= "spi_generic",};U_BOOT_DRIVER(spi_generic_drv) = {	.name		= "spi_generic_drv",	.id		= UCLASS_SPI_GENERIC,};
 |