123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211 |
- #include <linux/fpga/fpga-mgr.h>
- #include <linux/gpio/consumer.h>
- #include <linux/module.h>
- #include <linux/of_gpio.h>
- #include <linux/spi/spi.h>
- #include <linux/stringify.h>
- #define ICE40_SPI_MAX_SPEED 25000000
- #define ICE40_SPI_MIN_SPEED 1000000
- #define ICE40_SPI_RESET_DELAY 1
- #define ICE40_SPI_HOUSEKEEPING_DELAY 1200
- #define ICE40_SPI_NUM_ACTIVATION_BYTES DIV_ROUND_UP(49, 8)
- struct ice40_fpga_priv {
- struct spi_device *dev;
- struct gpio_desc *reset;
- struct gpio_desc *cdone;
- };
- static enum fpga_mgr_states ice40_fpga_ops_state(struct fpga_manager *mgr)
- {
- struct ice40_fpga_priv *priv = mgr->priv;
- return gpiod_get_value(priv->cdone) ? FPGA_MGR_STATE_OPERATING :
- FPGA_MGR_STATE_UNKNOWN;
- }
- static int ice40_fpga_ops_write_init(struct fpga_manager *mgr,
- struct fpga_image_info *info,
- const char *buf, size_t count)
- {
- struct ice40_fpga_priv *priv = mgr->priv;
- struct spi_device *dev = priv->dev;
- struct spi_message message;
- struct spi_transfer assert_cs_then_reset_delay = {
- .cs_change = 1,
- .delay = {
- .value = ICE40_SPI_RESET_DELAY,
- .unit = SPI_DELAY_UNIT_USECS
- }
- };
- struct spi_transfer housekeeping_delay_then_release_cs = {
- .delay = {
- .value = ICE40_SPI_HOUSEKEEPING_DELAY,
- .unit = SPI_DELAY_UNIT_USECS
- }
- };
- int ret;
- if ((info->flags & FPGA_MGR_PARTIAL_RECONFIG)) {
- dev_err(&dev->dev,
- "Partial reconfiguration is not supported\n");
- return -ENOTSUPP;
- }
-
- spi_bus_lock(dev->master);
- gpiod_set_value(priv->reset, 1);
- spi_message_init(&message);
- spi_message_add_tail(&assert_cs_then_reset_delay, &message);
- ret = spi_sync_locked(dev, &message);
-
- gpiod_set_value(priv->reset, 0);
-
- if (ret)
- goto fail;
-
- if (gpiod_get_value(priv->cdone)) {
- dev_err(&dev->dev, "Device reset failed, CDONE is asserted\n");
- ret = -EIO;
- goto fail;
- }
-
- spi_message_init(&message);
- spi_message_add_tail(&housekeeping_delay_then_release_cs, &message);
- ret = spi_sync_locked(dev, &message);
- fail:
- spi_bus_unlock(dev->master);
- return ret;
- }
- static int ice40_fpga_ops_write(struct fpga_manager *mgr,
- const char *buf, size_t count)
- {
- struct ice40_fpga_priv *priv = mgr->priv;
- return spi_write(priv->dev, buf, count);
- }
- static int ice40_fpga_ops_write_complete(struct fpga_manager *mgr,
- struct fpga_image_info *info)
- {
- struct ice40_fpga_priv *priv = mgr->priv;
- struct spi_device *dev = priv->dev;
- const u8 padding[ICE40_SPI_NUM_ACTIVATION_BYTES] = {0};
-
- if (!gpiod_get_value(priv->cdone)) {
- dev_err(&dev->dev,
- "CDONE was not asserted after firmware transfer\n");
- return -EIO;
- }
-
- return spi_write(dev, padding, sizeof(padding));
- }
- static const struct fpga_manager_ops ice40_fpga_ops = {
- .state = ice40_fpga_ops_state,
- .write_init = ice40_fpga_ops_write_init,
- .write = ice40_fpga_ops_write,
- .write_complete = ice40_fpga_ops_write_complete,
- };
- static int ice40_fpga_probe(struct spi_device *spi)
- {
- struct device *dev = &spi->dev;
- struct ice40_fpga_priv *priv;
- struct fpga_manager *mgr;
- int ret;
- priv = devm_kzalloc(&spi->dev, sizeof(*priv), GFP_KERNEL);
- if (!priv)
- return -ENOMEM;
- priv->dev = spi;
-
- if (spi->max_speed_hz > ICE40_SPI_MAX_SPEED) {
- dev_err(dev, "SPI speed is too high, maximum speed is "
- __stringify(ICE40_SPI_MAX_SPEED) "\n");
- return -EINVAL;
- }
- if (spi->max_speed_hz < ICE40_SPI_MIN_SPEED) {
- dev_err(dev, "SPI speed is too low, minimum speed is "
- __stringify(ICE40_SPI_MIN_SPEED) "\n");
- return -EINVAL;
- }
- if (spi->mode & SPI_CPHA) {
- dev_err(dev, "Bad SPI mode, CPHA not supported\n");
- return -EINVAL;
- }
-
- priv->cdone = devm_gpiod_get(dev, "cdone", GPIOD_IN);
- if (IS_ERR(priv->cdone)) {
- ret = PTR_ERR(priv->cdone);
- dev_err(dev, "Failed to get CDONE GPIO: %d\n", ret);
- return ret;
- }
- priv->reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
- if (IS_ERR(priv->reset)) {
- ret = PTR_ERR(priv->reset);
- dev_err(dev, "Failed to get CRESET_B GPIO: %d\n", ret);
- return ret;
- }
- mgr = devm_fpga_mgr_register(dev, "Lattice iCE40 FPGA Manager",
- &ice40_fpga_ops, priv);
- return PTR_ERR_OR_ZERO(mgr);
- }
- static const struct of_device_id ice40_fpga_of_match[] = {
- { .compatible = "lattice,ice40-fpga-mgr", },
- {},
- };
- MODULE_DEVICE_TABLE(of, ice40_fpga_of_match);
- static const struct spi_device_id ice40_fpga_spi_ids[] = {
- { .name = "ice40-fpga-mgr", },
- {},
- };
- MODULE_DEVICE_TABLE(spi, ice40_fpga_spi_ids);
- static struct spi_driver ice40_fpga_driver = {
- .probe = ice40_fpga_probe,
- .driver = {
- .name = "ice40spi",
- .of_match_table = of_match_ptr(ice40_fpga_of_match),
- },
- .id_table = ice40_fpga_spi_ids,
- };
- module_spi_driver(ice40_fpga_driver);
- MODULE_AUTHOR("Joel Holdsworth <joel@airwebreathe.org.uk>");
- MODULE_DESCRIPTION("Lattice iCE40 FPGA Manager");
- MODULE_LICENSE("GPL v2");
|