drivers/misc/lattice-ecp3-config.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Copyright (C) 2012 Stefan Roese <sr@denx.de>
   4  */
   5
   6 #include <linux/device.h>
   7 #include <linux/firmware.h>
   8 #include <linux/module.h>
   9 #include <linux/errno.h>
  10 #include <linux/kernel.h>
  11 #include <linux/spi/spi.h>
  12 #include <linux/platform_device.h>
  13 #include <linux/delay.h>
  14 #include <asm/unaligned.h>
  15
  16 #define FIRMWARE_NAME   "/*(DEBLOBBED)*/"
  17
  18 /*
  19  * The JTAG ID's of the supported FPGA's. The ID is 32bit wide
  20  * reversed as noted in the manual.
  21  */
  22 #define ID_ECP3_17      0xc2088080
  23 #define ID_ECP3_35      0xc2048080
  24
  25 /* FPGA commands */
  26 #define FPGA_CMD_READ_ID        0x07    /* plus 24 bits */
  27 #define FPGA_CMD_READ_STATUS    0x09    /* plus 24 bits */
  28 #define FPGA_CMD_CLEAR          0x70
  29 #define FPGA_CMD_REFRESH        0x71
  30 #define FPGA_CMD_WRITE_EN       0x4a    /* plus 2 bits */
  31 #define FPGA_CMD_WRITE_DIS      0x4f    /* plus 8 bits */
  32 #define FPGA_CMD_WRITE_INC      0x41    /* plus 0 bits */
  33
  34 /*
  35  * The status register is 32bit revered, DONE is bit 17 from the TN1222.pdf
  36  * (LatticeECP3 Slave SPI Port User's Guide)
  37  */
  38 #define FPGA_STATUS_DONE        0x00004000
  39 #define FPGA_STATUS_CLEARED     0x00010000
  40
  41 #define FPGA_CLEAR_TIMEOUT      5000    /* max. 5000ms for FPGA clear */
  42 #define FPGA_CLEAR_MSLEEP       10
  43 #define FPGA_CLEAR_LOOP_COUNT   (FPGA_CLEAR_TIMEOUT / FPGA_CLEAR_MSLEEP)
  44
  45 struct fpga_data {
  46         struct completion fw_loaded;
  47 };
  48
  49 struct ecp3_dev {
  50         u32 jedec_id;
  51         char *name;
  52 };
  53
  54 static const struct ecp3_dev ecp3_dev[] = {
  55         {
  56                 .jedec_id = ID_ECP3_17,
  57                 .name = "Lattice ECP3-17",
  58         },
  59         {
  60                 .jedec_id = ID_ECP3_35,
  61                 .name = "Lattice ECP3-35",
  62         },
  63 };
  64
  65 static void firmware_load(const struct firmware *fw, void *context)
  66 {
  67         struct spi_device *spi = (struct spi_device *)context;
  68         struct fpga_data *data = spi_get_drvdata(spi);
  69         u8 *buffer;
  70         int ret;
  71         u8 txbuf[8];
  72         u8 rxbuf[8];
  73         int rx_len = 8;
  74         int i;
  75         u32 jedec_id;
  76         u32 status;
  77
  78         if (fw == NULL) {
  79                 dev_err(&spi->dev, "Cannot load firmware, aborting\n");
  80                 return;
  81         }
  82
  83         if (fw->size == 0) {
  84                 dev_err(&spi->dev, "Error: Firmware size is 0!\n");
  85                 return;
  86         }
  87
  88         /* Fill dummy data (24 stuffing bits for commands) */
  89         txbuf[1] = 0x00;
  90         txbuf[2] = 0x00;
  91         txbuf[3] = 0x00;
  92
  93         /* Trying to speak with the FPGA via SPI... */
  94         txbuf[0] = FPGA_CMD_READ_ID;
  95         ret = spi_write_then_read(spi, txbuf, 8, rxbuf, rx_len);
  96         jedec_id = get_unaligned_be32(&rxbuf[4]);
  97         dev_dbg(&spi->dev, "FPGA JTAG ID=%08x\n", jedec_id);
  98
  99         for (i = 0; i < ARRAY_SIZE(ecp3_dev); i++) {
 100                 if (jedec_id == ecp3_dev[i].jedec_id)
 101                         break;
 102         }
 103         if (i == ARRAY_SIZE(ecp3_dev)) {
 104                 dev_err(&spi->dev,
 105                         "Error: No supported FPGA detected (JEDEC_ID=%08x)!\n",
 106                         jedec_id);
 107                 return;
 108         }
 109
 110         dev_info(&spi->dev, "FPGA %s detected\n", ecp3_dev[i].name);
 111
 112         txbuf[0] = FPGA_CMD_READ_STATUS;
 113         ret = spi_write_then_read(spi, txbuf, 8, rxbuf, rx_len);
 114         status = get_unaligned_be32(&rxbuf[4]);
 115         dev_dbg(&spi->dev, "FPGA Status=%08x\n", status);
 116
 117         buffer = kzalloc(fw->size + 8, GFP_KERNEL);
 118         if (!buffer) {
 119                 dev_err(&spi->dev, "Error: Can't allocate memory!\n");
 120                 return;
 121         }
 122
 123         /*
 124          * Insert WRITE_INC command into stream (one SPI frame)
 125          */
 126         buffer[0] = FPGA_CMD_WRITE_INC;
 127         buffer[1] = 0xff;
 128         buffer[2] = 0xff;
 129         buffer[3] = 0xff;
 130         memcpy(buffer + 4, fw->data, fw->size);
 131
 132         txbuf[0] = FPGA_CMD_REFRESH;
 133         ret = spi_write(spi, txbuf, 4);
 134
 135         txbuf[0] = FPGA_CMD_WRITE_EN;
 136         ret = spi_write(spi, txbuf, 4);
 137
 138         txbuf[0] = FPGA_CMD_CLEAR;
 139         ret = spi_write(spi, txbuf, 4);
 140
 141         /*
 142          * Wait for FPGA memory to become cleared
 143          */
 144         for (i = 0; i < FPGA_CLEAR_LOOP_COUNT; i++) {
 145                 txbuf[0] = FPGA_CMD_READ_STATUS;
 146                 ret = spi_write_then_read(spi, txbuf, 8, rxbuf, rx_len);
 147                 status = get_unaligned_be32(&rxbuf[4]);
 148                 if (status == FPGA_STATUS_CLEARED)
 149                         break;
 150
 151                 msleep(FPGA_CLEAR_MSLEEP);
 152         }
 153
 154         if (i == FPGA_CLEAR_LOOP_COUNT) {
 155                 dev_err(&spi->dev,
 156                         "Error: Timeout waiting for FPGA to clear (status=%08x)!\n",
 157                         status);
 158                 kfree(buffer);
 159                 return;
 160         }
 161
 162         dev_info(&spi->dev, "Configuring the FPGA...\n");
 163         ret = spi_write(spi, buffer, fw->size + 8);
 164
 165         txbuf[0] = FPGA_CMD_WRITE_DIS;
 166         ret = spi_write(spi, txbuf, 4);
 167
 168         txbuf[0] = FPGA_CMD_READ_STATUS;
 169         ret = spi_write_then_read(spi, txbuf, 8, rxbuf, rx_len);
 170         status = get_unaligned_be32(&rxbuf[4]);
 171         dev_dbg(&spi->dev, "FPGA Status=%08x\n", status);
 172
 173         /* Check result */
 174         if (status & FPGA_STATUS_DONE)
 175                 dev_info(&spi->dev, "FPGA successfully configured!\n");
 176         else
 177                 dev_info(&spi->dev, "FPGA not configured (DONE not set)\n");
 178
 179         /*
 180          * Don't forget to release the firmware again
 181          */
 182         release_firmware(fw);
 183
 184         kfree(buffer);
 185
 186         complete(&data->fw_loaded);
 187 }
 188
 189 static int lattice_ecp3_probe(struct spi_device *spi)
 190 {
 191         struct fpga_data *data;
 192         int err;
 193
 194         data = devm_kzalloc(&spi->dev, sizeof(*data), GFP_KERNEL);
 195         if (!data) {
 196                 dev_err(&spi->dev, "Memory allocation for fpga_data failed\n");
 197                 return -ENOMEM;
 198         }
 199         spi_set_drvdata(spi, data);
 200
 201         init_completion(&data->fw_loaded);
 202         err = reject_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG,
 203                                       FIRMWARE_NAME, &spi->dev,
 204                                       GFP_KERNEL, spi, firmware_load);
 205         if (err) {
 206                 dev_err(&spi->dev, "Firmware loading failed with %d!\n", err);
 207                 return err;
 208         }
 209
 210         dev_info(&spi->dev, "FPGA bitstream configuration driver registered\n");
 211
 212         return 0;
 213 }
 214
 215 static int lattice_ecp3_remove(struct spi_device *spi)
 216 {
 217         struct fpga_data *data = spi_get_drvdata(spi);
 218
 219         wait_for_completion(&data->fw_loaded);
 220
 221         return 0;
 222 }
 223
 224 static const struct spi_device_id lattice_ecp3_id[] = {
 225         { "ecp3-17", 0 },
 226         { "ecp3-35", 0 },
 227         { }
 228 };
 229 MODULE_DEVICE_TABLE(spi, lattice_ecp3_id);
 230
 231 static struct spi_driver lattice_ecp3_driver = {
 232         .driver = {
 233                 .name = "lattice-ecp3",
 234         },
 235         .probe = lattice_ecp3_probe,
 236         .remove = lattice_ecp3_remove,
 237         .id_table = lattice_ecp3_id,
 238 };
 239
 240 module_spi_driver(lattice_ecp3_driver);
 241
 242 MODULE_AUTHOR("Stefan Roese <sr@denx.de>");
 243 MODULE_DESCRIPTION("Lattice ECP3 FPGA configuration via SPI");
 244 MODULE_LICENSE("GPL");
 245 /*(DEBLOBBED)*/