1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * SPI-Engine SPI controller driver 4 * Copyright 2015 Analog Devices Inc. 5 * Author: Lars-Peter Clausen <lars@metafoo.de> 6 */ 7 8 #include <linux/clk.h> 9 #include <linux/interrupt.h> 10 #include <linux/io.h> 11 #include <linux/of.h> 12 #include <linux/module.h> 13 #include <linux/platform_device.h> 14 #include <linux/spi/spi.h> 15 16 #define SPI_ENGINE_VERSION_MAJOR(x) ((x >> 16) & 0xff) 17 #define SPI_ENGINE_VERSION_MINOR(x) ((x >> 8) & 0xff) 18 #define SPI_ENGINE_VERSION_PATCH(x) (x & 0xff) 19 20 #define SPI_ENGINE_REG_VERSION 0x00 21 22 #define SPI_ENGINE_REG_RESET 0x40 23 24 #define SPI_ENGINE_REG_INT_ENABLE 0x80 25 #define SPI_ENGINE_REG_INT_PENDING 0x84 26 #define SPI_ENGINE_REG_INT_SOURCE 0x88 27 28 #define SPI_ENGINE_REG_SYNC_ID 0xc0 29 30 #define SPI_ENGINE_REG_CMD_FIFO_ROOM 0xd0 31 #define SPI_ENGINE_REG_SDO_FIFO_ROOM 0xd4 32 #define SPI_ENGINE_REG_SDI_FIFO_LEVEL 0xd8 33 34 #define SPI_ENGINE_REG_CMD_FIFO 0xe0 35 #define SPI_ENGINE_REG_SDO_DATA_FIFO 0xe4 36 #define SPI_ENGINE_REG_SDI_DATA_FIFO 0xe8 37 #define SPI_ENGINE_REG_SDI_DATA_FIFO_PEEK 0xec 38 39 #define SPI_ENGINE_INT_CMD_ALMOST_EMPTY BIT(0) 40 #define SPI_ENGINE_INT_SDO_ALMOST_EMPTY BIT(1) 41 #define SPI_ENGINE_INT_SDI_ALMOST_FULL BIT(2) 42 #define SPI_ENGINE_INT_SYNC BIT(3) 43 44 #define SPI_ENGINE_CONFIG_CPHA BIT(0) 45 #define SPI_ENGINE_CONFIG_CPOL BIT(1) 46 #define SPI_ENGINE_CONFIG_3WIRE BIT(2) 47 48 #define SPI_ENGINE_INST_TRANSFER 0x0 49 #define SPI_ENGINE_INST_ASSERT 0x1 50 #define SPI_ENGINE_INST_WRITE 0x2 51 #define SPI_ENGINE_INST_MISC 0x3 52 53 #define SPI_ENGINE_CMD_REG_CLK_DIV 0x0 54 #define SPI_ENGINE_CMD_REG_CONFIG 0x1 55 56 #define SPI_ENGINE_MISC_SYNC 0x0 57 #define SPI_ENGINE_MISC_SLEEP 0x1 58 59 #define SPI_ENGINE_TRANSFER_WRITE 0x1 60 #define SPI_ENGINE_TRANSFER_READ 0x2 61 62 #define SPI_ENGINE_CMD(inst, arg1, arg2) \ 63 (((inst) << 12) | ((arg1) << 8) | (arg2)) 64 65 #define SPI_ENGINE_CMD_TRANSFER(flags, n) \ 66 SPI_ENGINE_CMD(SPI_ENGINE_INST_TRANSFER, (flags), (n)) 67 #define SPI_ENGINE_CMD_ASSERT(delay, cs) \ 68 SPI_ENGINE_CMD(SPI_ENGINE_INST_ASSERT, (delay), (cs)) 69 #define SPI_ENGINE_CMD_WRITE(reg, val) \ 70 SPI_ENGINE_CMD(SPI_ENGINE_INST_WRITE, (reg), (val)) 71 #define SPI_ENGINE_CMD_SLEEP(delay) \ 72 SPI_ENGINE_CMD(SPI_ENGINE_INST_MISC, SPI_ENGINE_MISC_SLEEP, (delay)) 73 #define SPI_ENGINE_CMD_SYNC(id) \ 74 SPI_ENGINE_CMD(SPI_ENGINE_INST_MISC, SPI_ENGINE_MISC_SYNC, (id)) 75 76 struct spi_engine_program { 77 unsigned int length; 78 uint16_t instructions[]; 79 }; 80 81 struct spi_engine { 82 struct clk *clk; 83 struct clk *ref_clk; 84 85 spinlock_t lock; 86 87 void __iomem *base; 88 89 struct spi_message *msg; 90 struct spi_engine_program *p; 91 unsigned cmd_length; 92 const uint16_t *cmd_buf; 93 94 struct spi_transfer *tx_xfer; 95 unsigned int tx_length; 96 const uint8_t *tx_buf; 97 98 struct spi_transfer *rx_xfer; 99 unsigned int rx_length; 100 uint8_t *rx_buf; 101 102 unsigned int sync_id; 103 unsigned int completed_id; 104 105 unsigned int int_enable; 106 }; 107 108 static void spi_engine_program_add_cmd(struct spi_engine_program *p, 109 bool dry, uint16_t cmd) 110 { 111 if (!dry) 112 p->instructions[p->length] = cmd; 113 p->length++; 114 } 115 116 static unsigned int spi_engine_get_config(struct spi_device *spi) 117 { 118 unsigned int config = 0; 119 120 if (spi->mode & SPI_CPOL) 121 config |= SPI_ENGINE_CONFIG_CPOL; 122 if (spi->mode & SPI_CPHA) 123 config |= SPI_ENGINE_CONFIG_CPHA; 124 if (spi->mode & SPI_3WIRE) 125 config |= SPI_ENGINE_CONFIG_3WIRE; 126 127 return config; 128 } 129 130 static unsigned int spi_engine_get_clk_div(struct spi_engine *spi_engine, 131 struct spi_device *spi, struct spi_transfer *xfer) 132 { 133 unsigned int clk_div; 134 135 clk_div = DIV_ROUND_UP(clk_get_rate(spi_engine->ref_clk), 136 xfer->speed_hz * 2); 137 if (clk_div > 255) 138 clk_div = 255; 139 else if (clk_div > 0) 140 clk_div -= 1; 141 142 return clk_div; 143 } 144 145 static void spi_engine_gen_xfer(struct spi_engine_program *p, bool dry, 146 struct spi_transfer *xfer) 147 { 148 unsigned int len = xfer->len; 149 150 while (len) { 151 unsigned int n = min(len, 256U); 152 unsigned int flags = 0; 153 154 if (xfer->tx_buf) 155 flags |= SPI_ENGINE_TRANSFER_WRITE; 156 if (xfer->rx_buf) 157 flags |= SPI_ENGINE_TRANSFER_READ; 158 159 spi_engine_program_add_cmd(p, dry, 160 SPI_ENGINE_CMD_TRANSFER(flags, n - 1)); 161 len -= n; 162 } 163 } 164 165 static void spi_engine_gen_sleep(struct spi_engine_program *p, bool dry, 166 struct spi_engine *spi_engine, unsigned int clk_div, 167 struct spi_transfer *xfer) 168 { 169 unsigned int spi_clk = clk_get_rate(spi_engine->ref_clk); 170 unsigned int t; 171 int delay; 172 173 delay = spi_delay_to_ns(&xfer->delay, xfer); 174 if (delay < 0) 175 return; 176 delay /= 1000; 177 178 if (delay == 0) 179 return; 180 181 t = DIV_ROUND_UP(delay * spi_clk, (clk_div + 1) * 2); 182 while (t) { 183 unsigned int n = min(t, 256U); 184 185 spi_engine_program_add_cmd(p, dry, SPI_ENGINE_CMD_SLEEP(n - 1)); 186 t -= n; 187 } 188 } 189 190 static void spi_engine_gen_cs(struct spi_engine_program *p, bool dry, 191 struct spi_device *spi, bool assert) 192 { 193 unsigned int mask = 0xff; 194 195 if (assert) 196 mask ^= BIT(spi_get_chipselect(spi, 0)); 197 198 spi_engine_program_add_cmd(p, dry, SPI_ENGINE_CMD_ASSERT(1, mask)); 199 } 200 201 static int spi_engine_compile_message(struct spi_engine *spi_engine, 202 struct spi_message *msg, bool dry, struct spi_engine_program *p) 203 { 204 struct spi_device *spi = msg->spi; 205 struct spi_transfer *xfer; 206 int clk_div, new_clk_div; 207 bool cs_change = true; 208 209 clk_div = -1; 210 211 spi_engine_program_add_cmd(p, dry, 212 SPI_ENGINE_CMD_WRITE(SPI_ENGINE_CMD_REG_CONFIG, 213 spi_engine_get_config(spi))); 214 215 list_for_each_entry(xfer, &msg->transfers, transfer_list) { 216 new_clk_div = spi_engine_get_clk_div(spi_engine, spi, xfer); 217 if (new_clk_div != clk_div) { 218 clk_div = new_clk_div; 219 spi_engine_program_add_cmd(p, dry, 220 SPI_ENGINE_CMD_WRITE(SPI_ENGINE_CMD_REG_CLK_DIV, 221 clk_div)); 222 } 223 224 if (cs_change) 225 spi_engine_gen_cs(p, dry, spi, true); 226 227 spi_engine_gen_xfer(p, dry, xfer); 228 spi_engine_gen_sleep(p, dry, spi_engine, clk_div, xfer); 229 230 cs_change = xfer->cs_change; 231 if (list_is_last(&xfer->transfer_list, &msg->transfers)) 232 cs_change = !cs_change; 233 234 if (cs_change) 235 spi_engine_gen_cs(p, dry, spi, false); 236 } 237 238 return 0; 239 } 240 241 static void spi_engine_xfer_next(struct spi_engine *spi_engine, 242 struct spi_transfer **_xfer) 243 { 244 struct spi_message *msg = spi_engine->msg; 245 struct spi_transfer *xfer = *_xfer; 246 247 if (!xfer) { 248 xfer = list_first_entry(&msg->transfers, 249 struct spi_transfer, transfer_list); 250 } else if (list_is_last(&xfer->transfer_list, &msg->transfers)) { 251 xfer = NULL; 252 } else { 253 xfer = list_next_entry(xfer, transfer_list); 254 } 255 256 *_xfer = xfer; 257 } 258 259 static void spi_engine_tx_next(struct spi_engine *spi_engine) 260 { 261 struct spi_transfer *xfer = spi_engine->tx_xfer; 262 263 do { 264 spi_engine_xfer_next(spi_engine, &xfer); 265 } while (xfer && !xfer->tx_buf); 266 267 spi_engine->tx_xfer = xfer; 268 if (xfer) { 269 spi_engine->tx_length = xfer->len; 270 spi_engine->tx_buf = xfer->tx_buf; 271 } else { 272 spi_engine->tx_buf = NULL; 273 } 274 } 275 276 static void spi_engine_rx_next(struct spi_engine *spi_engine) 277 { 278 struct spi_transfer *xfer = spi_engine->rx_xfer; 279 280 do { 281 spi_engine_xfer_next(spi_engine, &xfer); 282 } while (xfer && !xfer->rx_buf); 283 284 spi_engine->rx_xfer = xfer; 285 if (xfer) { 286 spi_engine->rx_length = xfer->len; 287 spi_engine->rx_buf = xfer->rx_buf; 288 } else { 289 spi_engine->rx_buf = NULL; 290 } 291 } 292 293 static bool spi_engine_write_cmd_fifo(struct spi_engine *spi_engine) 294 { 295 void __iomem *addr = spi_engine->base + SPI_ENGINE_REG_CMD_FIFO; 296 unsigned int n, m, i; 297 const uint16_t *buf; 298 299 n = readl_relaxed(spi_engine->base + SPI_ENGINE_REG_CMD_FIFO_ROOM); 300 while (n && spi_engine->cmd_length) { 301 m = min(n, spi_engine->cmd_length); 302 buf = spi_engine->cmd_buf; 303 for (i = 0; i < m; i++) 304 writel_relaxed(buf[i], addr); 305 spi_engine->cmd_buf += m; 306 spi_engine->cmd_length -= m; 307 n -= m; 308 } 309 310 return spi_engine->cmd_length != 0; 311 } 312 313 static bool spi_engine_write_tx_fifo(struct spi_engine *spi_engine) 314 { 315 void __iomem *addr = spi_engine->base + SPI_ENGINE_REG_SDO_DATA_FIFO; 316 unsigned int n, m, i; 317 const uint8_t *buf; 318 319 n = readl_relaxed(spi_engine->base + SPI_ENGINE_REG_SDO_FIFO_ROOM); 320 while (n && spi_engine->tx_length) { 321 m = min(n, spi_engine->tx_length); 322 buf = spi_engine->tx_buf; 323 for (i = 0; i < m; i++) 324 writel_relaxed(buf[i], addr); 325 spi_engine->tx_buf += m; 326 spi_engine->tx_length -= m; 327 n -= m; 328 if (spi_engine->tx_length == 0) 329 spi_engine_tx_next(spi_engine); 330 } 331 332 return spi_engine->tx_length != 0; 333 } 334 335 static bool spi_engine_read_rx_fifo(struct spi_engine *spi_engine) 336 { 337 void __iomem *addr = spi_engine->base + SPI_ENGINE_REG_SDI_DATA_FIFO; 338 unsigned int n, m, i; 339 uint8_t *buf; 340 341 n = readl_relaxed(spi_engine->base + SPI_ENGINE_REG_SDI_FIFO_LEVEL); 342 while (n && spi_engine->rx_length) { 343 m = min(n, spi_engine->rx_length); 344 buf = spi_engine->rx_buf; 345 for (i = 0; i < m; i++) 346 buf[i] = readl_relaxed(addr); 347 spi_engine->rx_buf += m; 348 spi_engine->rx_length -= m; 349 n -= m; 350 if (spi_engine->rx_length == 0) 351 spi_engine_rx_next(spi_engine); 352 } 353 354 return spi_engine->rx_length != 0; 355 } 356 357 static irqreturn_t spi_engine_irq(int irq, void *devid) 358 { 359 struct spi_controller *host = devid; 360 struct spi_engine *spi_engine = spi_controller_get_devdata(host); 361 unsigned int disable_int = 0; 362 unsigned int pending; 363 364 pending = readl_relaxed(spi_engine->base + SPI_ENGINE_REG_INT_PENDING); 365 366 if (pending & SPI_ENGINE_INT_SYNC) { 367 writel_relaxed(SPI_ENGINE_INT_SYNC, 368 spi_engine->base + SPI_ENGINE_REG_INT_PENDING); 369 spi_engine->completed_id = readl_relaxed( 370 spi_engine->base + SPI_ENGINE_REG_SYNC_ID); 371 } 372 373 spin_lock(&spi_engine->lock); 374 375 if (pending & SPI_ENGINE_INT_CMD_ALMOST_EMPTY) { 376 if (!spi_engine_write_cmd_fifo(spi_engine)) 377 disable_int |= SPI_ENGINE_INT_CMD_ALMOST_EMPTY; 378 } 379 380 if (pending & SPI_ENGINE_INT_SDO_ALMOST_EMPTY) { 381 if (!spi_engine_write_tx_fifo(spi_engine)) 382 disable_int |= SPI_ENGINE_INT_SDO_ALMOST_EMPTY; 383 } 384 385 if (pending & (SPI_ENGINE_INT_SDI_ALMOST_FULL | SPI_ENGINE_INT_SYNC)) { 386 if (!spi_engine_read_rx_fifo(spi_engine)) 387 disable_int |= SPI_ENGINE_INT_SDI_ALMOST_FULL; 388 } 389 390 if (pending & SPI_ENGINE_INT_SYNC) { 391 if (spi_engine->msg && 392 spi_engine->completed_id == spi_engine->sync_id) { 393 struct spi_message *msg = spi_engine->msg; 394 395 kfree(spi_engine->p); 396 msg->status = 0; 397 msg->actual_length = msg->frame_length; 398 spi_engine->msg = NULL; 399 spi_finalize_current_message(host); 400 disable_int |= SPI_ENGINE_INT_SYNC; 401 } 402 } 403 404 if (disable_int) { 405 spi_engine->int_enable &= ~disable_int; 406 writel_relaxed(spi_engine->int_enable, 407 spi_engine->base + SPI_ENGINE_REG_INT_ENABLE); 408 } 409 410 spin_unlock(&spi_engine->lock); 411 412 return IRQ_HANDLED; 413 } 414 415 static int spi_engine_transfer_one_message(struct spi_controller *host, 416 struct spi_message *msg) 417 { 418 struct spi_engine_program p_dry, *p; 419 struct spi_engine *spi_engine = spi_controller_get_devdata(host); 420 unsigned int int_enable = 0; 421 unsigned long flags; 422 size_t size; 423 424 p_dry.length = 0; 425 spi_engine_compile_message(spi_engine, msg, true, &p_dry); 426 427 size = sizeof(*p->instructions) * (p_dry.length + 1); 428 p = kzalloc(sizeof(*p) + size, GFP_KERNEL); 429 if (!p) 430 return -ENOMEM; 431 spi_engine_compile_message(spi_engine, msg, false, p); 432 433 spin_lock_irqsave(&spi_engine->lock, flags); 434 spi_engine->sync_id = (spi_engine->sync_id + 1) & 0xff; 435 spi_engine_program_add_cmd(p, false, 436 SPI_ENGINE_CMD_SYNC(spi_engine->sync_id)); 437 438 spi_engine->msg = msg; 439 spi_engine->p = p; 440 441 spi_engine->cmd_buf = p->instructions; 442 spi_engine->cmd_length = p->length; 443 if (spi_engine_write_cmd_fifo(spi_engine)) 444 int_enable |= SPI_ENGINE_INT_CMD_ALMOST_EMPTY; 445 446 spi_engine_tx_next(spi_engine); 447 if (spi_engine_write_tx_fifo(spi_engine)) 448 int_enable |= SPI_ENGINE_INT_SDO_ALMOST_EMPTY; 449 450 spi_engine_rx_next(spi_engine); 451 if (spi_engine->rx_length != 0) 452 int_enable |= SPI_ENGINE_INT_SDI_ALMOST_FULL; 453 454 int_enable |= SPI_ENGINE_INT_SYNC; 455 456 writel_relaxed(int_enable, 457 spi_engine->base + SPI_ENGINE_REG_INT_ENABLE); 458 spi_engine->int_enable = int_enable; 459 spin_unlock_irqrestore(&spi_engine->lock, flags); 460 461 return 0; 462 } 463 464 static int spi_engine_probe(struct platform_device *pdev) 465 { 466 struct spi_engine *spi_engine; 467 struct spi_controller *host; 468 unsigned int version; 469 int irq; 470 int ret; 471 472 irq = platform_get_irq(pdev, 0); 473 if (irq < 0) 474 return irq; 475 476 spi_engine = devm_kzalloc(&pdev->dev, sizeof(*spi_engine), GFP_KERNEL); 477 if (!spi_engine) 478 return -ENOMEM; 479 480 host = spi_alloc_host(&pdev->dev, 0); 481 if (!host) 482 return -ENOMEM; 483 484 spi_controller_set_devdata(host, spi_engine); 485 486 spin_lock_init(&spi_engine->lock); 487 488 spi_engine->clk = devm_clk_get(&pdev->dev, "s_axi_aclk"); 489 if (IS_ERR(spi_engine->clk)) { 490 ret = PTR_ERR(spi_engine->clk); 491 goto err_put_host; 492 } 493 494 spi_engine->ref_clk = devm_clk_get(&pdev->dev, "spi_clk"); 495 if (IS_ERR(spi_engine->ref_clk)) { 496 ret = PTR_ERR(spi_engine->ref_clk); 497 goto err_put_host; 498 } 499 500 ret = clk_prepare_enable(spi_engine->clk); 501 if (ret) 502 goto err_put_host; 503 504 ret = clk_prepare_enable(spi_engine->ref_clk); 505 if (ret) 506 goto err_clk_disable; 507 508 spi_engine->base = devm_platform_ioremap_resource(pdev, 0); 509 if (IS_ERR(spi_engine->base)) { 510 ret = PTR_ERR(spi_engine->base); 511 goto err_ref_clk_disable; 512 } 513 514 version = readl(spi_engine->base + SPI_ENGINE_REG_VERSION); 515 if (SPI_ENGINE_VERSION_MAJOR(version) != 1) { 516 dev_err(&pdev->dev, "Unsupported peripheral version %u.%u.%c\n", 517 SPI_ENGINE_VERSION_MAJOR(version), 518 SPI_ENGINE_VERSION_MINOR(version), 519 SPI_ENGINE_VERSION_PATCH(version)); 520 ret = -ENODEV; 521 goto err_ref_clk_disable; 522 } 523 524 writel_relaxed(0x00, spi_engine->base + SPI_ENGINE_REG_RESET); 525 writel_relaxed(0xff, spi_engine->base + SPI_ENGINE_REG_INT_PENDING); 526 writel_relaxed(0x00, spi_engine->base + SPI_ENGINE_REG_INT_ENABLE); 527 528 ret = request_irq(irq, spi_engine_irq, 0, pdev->name, host); 529 if (ret) 530 goto err_ref_clk_disable; 531 532 host->dev.of_node = pdev->dev.of_node; 533 host->mode_bits = SPI_CPOL | SPI_CPHA | SPI_3WIRE; 534 host->bits_per_word_mask = SPI_BPW_MASK(8); 535 host->max_speed_hz = clk_get_rate(spi_engine->ref_clk) / 2; 536 host->transfer_one_message = spi_engine_transfer_one_message; 537 host->num_chipselect = 8; 538 539 ret = spi_register_controller(host); 540 if (ret) 541 goto err_free_irq; 542 543 platform_set_drvdata(pdev, host); 544 545 return 0; 546 err_free_irq: 547 free_irq(irq, host); 548 err_ref_clk_disable: 549 clk_disable_unprepare(spi_engine->ref_clk); 550 err_clk_disable: 551 clk_disable_unprepare(spi_engine->clk); 552 err_put_host: 553 spi_controller_put(host); 554 return ret; 555 } 556 557 static void spi_engine_remove(struct platform_device *pdev) 558 { 559 struct spi_controller *host = spi_controller_get(platform_get_drvdata(pdev)); 560 struct spi_engine *spi_engine = spi_controller_get_devdata(host); 561 int irq = platform_get_irq(pdev, 0); 562 563 spi_unregister_controller(host); 564 565 free_irq(irq, host); 566 567 spi_controller_put(host); 568 569 writel_relaxed(0xff, spi_engine->base + SPI_ENGINE_REG_INT_PENDING); 570 writel_relaxed(0x00, spi_engine->base + SPI_ENGINE_REG_INT_ENABLE); 571 writel_relaxed(0x01, spi_engine->base + SPI_ENGINE_REG_RESET); 572 573 clk_disable_unprepare(spi_engine->ref_clk); 574 clk_disable_unprepare(spi_engine->clk); 575 } 576 577 static const struct of_device_id spi_engine_match_table[] = { 578 { .compatible = "adi,axi-spi-engine-1.00.a" }, 579 { }, 580 }; 581 MODULE_DEVICE_TABLE(of, spi_engine_match_table); 582 583 static struct platform_driver spi_engine_driver = { 584 .probe = spi_engine_probe, 585 .remove_new = spi_engine_remove, 586 .driver = { 587 .name = "spi-engine", 588 .of_match_table = spi_engine_match_table, 589 }, 590 }; 591 module_platform_driver(spi_engine_driver); 592 593 MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>"); 594 MODULE_DESCRIPTION("Analog Devices SPI engine peripheral driver"); 595 MODULE_LICENSE("GPL"); 596