1 /* 2 * Marvell Orion SPI controller driver 3 * 4 * Author: Shadi Ammouri <shadi@marvell.com> 5 * Copyright (C) 2007-2008 Marvell Ltd. 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License version 2 as 9 * published by the Free Software Foundation. 10 */ 11 12 #include <linux/init.h> 13 #include <linux/interrupt.h> 14 #include <linux/delay.h> 15 #include <linux/platform_device.h> 16 #include <linux/err.h> 17 #include <linux/io.h> 18 #include <linux/spi/spi.h> 19 #include <linux/spi/orion_spi.h> 20 #include <linux/module.h> 21 #include <asm/unaligned.h> 22 23 #define DRIVER_NAME "orion_spi" 24 25 #define ORION_NUM_CHIPSELECTS 1 /* only one slave is supported*/ 26 #define ORION_SPI_WAIT_RDY_MAX_LOOP 2000 /* in usec */ 27 28 #define ORION_SPI_IF_CTRL_REG 0x00 29 #define ORION_SPI_IF_CONFIG_REG 0x04 30 #define ORION_SPI_DATA_OUT_REG 0x08 31 #define ORION_SPI_DATA_IN_REG 0x0c 32 #define ORION_SPI_INT_CAUSE_REG 0x10 33 34 #define ORION_SPI_IF_8_16_BIT_MODE (1 << 5) 35 #define ORION_SPI_CLK_PRESCALE_MASK 0x1F 36 37 struct orion_spi { 38 struct work_struct work; 39 40 /* Lock access to transfer list. */ 41 spinlock_t lock; 42 43 struct list_head msg_queue; 44 struct spi_master *master; 45 void __iomem *base; 46 unsigned int max_speed; 47 unsigned int min_speed; 48 struct orion_spi_info *spi_info; 49 }; 50 51 static struct workqueue_struct *orion_spi_wq; 52 53 static inline void __iomem *spi_reg(struct orion_spi *orion_spi, u32 reg) 54 { 55 return orion_spi->base + reg; 56 } 57 58 static inline void 59 orion_spi_setbits(struct orion_spi *orion_spi, u32 reg, u32 mask) 60 { 61 void __iomem *reg_addr = spi_reg(orion_spi, reg); 62 u32 val; 63 64 val = readl(reg_addr); 65 val |= mask; 66 writel(val, reg_addr); 67 } 68 69 static inline void 70 orion_spi_clrbits(struct orion_spi *orion_spi, u32 reg, u32 mask) 71 { 72 void __iomem *reg_addr = spi_reg(orion_spi, reg); 73 u32 val; 74 75 val = readl(reg_addr); 76 val &= ~mask; 77 writel(val, reg_addr); 78 } 79 80 static int orion_spi_set_transfer_size(struct orion_spi *orion_spi, int size) 81 { 82 if (size == 16) { 83 orion_spi_setbits(orion_spi, ORION_SPI_IF_CONFIG_REG, 84 ORION_SPI_IF_8_16_BIT_MODE); 85 } else if (size == 8) { 86 orion_spi_clrbits(orion_spi, ORION_SPI_IF_CONFIG_REG, 87 ORION_SPI_IF_8_16_BIT_MODE); 88 } else { 89 pr_debug("Bad bits per word value %d (only 8 or 16 are " 90 "allowed).\n", size); 91 return -EINVAL; 92 } 93 94 return 0; 95 } 96 97 static int orion_spi_baudrate_set(struct spi_device *spi, unsigned int speed) 98 { 99 u32 tclk_hz; 100 u32 rate; 101 u32 prescale; 102 u32 reg; 103 struct orion_spi *orion_spi; 104 105 orion_spi = spi_master_get_devdata(spi->master); 106 107 tclk_hz = orion_spi->spi_info->tclk; 108 109 /* 110 * the supported rates are: 4,6,8...30 111 * round up as we look for equal or less speed 112 */ 113 rate = DIV_ROUND_UP(tclk_hz, speed); 114 rate = roundup(rate, 2); 115 116 /* check if requested speed is too small */ 117 if (rate > 30) 118 return -EINVAL; 119 120 if (rate < 4) 121 rate = 4; 122 123 /* Convert the rate to SPI clock divisor value. */ 124 prescale = 0x10 + rate/2; 125 126 reg = readl(spi_reg(orion_spi, ORION_SPI_IF_CONFIG_REG)); 127 reg = ((reg & ~ORION_SPI_CLK_PRESCALE_MASK) | prescale); 128 writel(reg, spi_reg(orion_spi, ORION_SPI_IF_CONFIG_REG)); 129 130 return 0; 131 } 132 133 /* 134 * called only when no transfer is active on the bus 135 */ 136 static int 137 orion_spi_setup_transfer(struct spi_device *spi, struct spi_transfer *t) 138 { 139 struct orion_spi *orion_spi; 140 unsigned int speed = spi->max_speed_hz; 141 unsigned int bits_per_word = spi->bits_per_word; 142 int rc; 143 144 orion_spi = spi_master_get_devdata(spi->master); 145 146 if ((t != NULL) && t->speed_hz) 147 speed = t->speed_hz; 148 149 if ((t != NULL) && t->bits_per_word) 150 bits_per_word = t->bits_per_word; 151 152 rc = orion_spi_baudrate_set(spi, speed); 153 if (rc) 154 return rc; 155 156 return orion_spi_set_transfer_size(orion_spi, bits_per_word); 157 } 158 159 static void orion_spi_set_cs(struct orion_spi *orion_spi, int enable) 160 { 161 if (enable) 162 orion_spi_setbits(orion_spi, ORION_SPI_IF_CTRL_REG, 0x1); 163 else 164 orion_spi_clrbits(orion_spi, ORION_SPI_IF_CTRL_REG, 0x1); 165 } 166 167 static inline int orion_spi_wait_till_ready(struct orion_spi *orion_spi) 168 { 169 int i; 170 171 for (i = 0; i < ORION_SPI_WAIT_RDY_MAX_LOOP; i++) { 172 if (readl(spi_reg(orion_spi, ORION_SPI_INT_CAUSE_REG))) 173 return 1; 174 else 175 udelay(1); 176 } 177 178 return -1; 179 } 180 181 static inline int 182 orion_spi_write_read_8bit(struct spi_device *spi, 183 const u8 **tx_buf, u8 **rx_buf) 184 { 185 void __iomem *tx_reg, *rx_reg, *int_reg; 186 struct orion_spi *orion_spi; 187 188 orion_spi = spi_master_get_devdata(spi->master); 189 tx_reg = spi_reg(orion_spi, ORION_SPI_DATA_OUT_REG); 190 rx_reg = spi_reg(orion_spi, ORION_SPI_DATA_IN_REG); 191 int_reg = spi_reg(orion_spi, ORION_SPI_INT_CAUSE_REG); 192 193 /* clear the interrupt cause register */ 194 writel(0x0, int_reg); 195 196 if (tx_buf && *tx_buf) 197 writel(*(*tx_buf)++, tx_reg); 198 else 199 writel(0, tx_reg); 200 201 if (orion_spi_wait_till_ready(orion_spi) < 0) { 202 dev_err(&spi->dev, "TXS timed out\n"); 203 return -1; 204 } 205 206 if (rx_buf && *rx_buf) 207 *(*rx_buf)++ = readl(rx_reg); 208 209 return 1; 210 } 211 212 static inline int 213 orion_spi_write_read_16bit(struct spi_device *spi, 214 const u16 **tx_buf, u16 **rx_buf) 215 { 216 void __iomem *tx_reg, *rx_reg, *int_reg; 217 struct orion_spi *orion_spi; 218 219 orion_spi = spi_master_get_devdata(spi->master); 220 tx_reg = spi_reg(orion_spi, ORION_SPI_DATA_OUT_REG); 221 rx_reg = spi_reg(orion_spi, ORION_SPI_DATA_IN_REG); 222 int_reg = spi_reg(orion_spi, ORION_SPI_INT_CAUSE_REG); 223 224 /* clear the interrupt cause register */ 225 writel(0x0, int_reg); 226 227 if (tx_buf && *tx_buf) 228 writel(__cpu_to_le16(get_unaligned((*tx_buf)++)), tx_reg); 229 else 230 writel(0, tx_reg); 231 232 if (orion_spi_wait_till_ready(orion_spi) < 0) { 233 dev_err(&spi->dev, "TXS timed out\n"); 234 return -1; 235 } 236 237 if (rx_buf && *rx_buf) 238 put_unaligned(__le16_to_cpu(readl(rx_reg)), (*rx_buf)++); 239 240 return 1; 241 } 242 243 static unsigned int 244 orion_spi_write_read(struct spi_device *spi, struct spi_transfer *xfer) 245 { 246 struct orion_spi *orion_spi; 247 unsigned int count; 248 int word_len; 249 250 orion_spi = spi_master_get_devdata(spi->master); 251 word_len = spi->bits_per_word; 252 count = xfer->len; 253 254 if (word_len == 8) { 255 const u8 *tx = xfer->tx_buf; 256 u8 *rx = xfer->rx_buf; 257 258 do { 259 if (orion_spi_write_read_8bit(spi, &tx, &rx) < 0) 260 goto out; 261 count--; 262 } while (count); 263 } else if (word_len == 16) { 264 const u16 *tx = xfer->tx_buf; 265 u16 *rx = xfer->rx_buf; 266 267 do { 268 if (orion_spi_write_read_16bit(spi, &tx, &rx) < 0) 269 goto out; 270 count -= 2; 271 } while (count); 272 } 273 274 out: 275 return xfer->len - count; 276 } 277 278 279 static void orion_spi_work(struct work_struct *work) 280 { 281 struct orion_spi *orion_spi = 282 container_of(work, struct orion_spi, work); 283 284 spin_lock_irq(&orion_spi->lock); 285 while (!list_empty(&orion_spi->msg_queue)) { 286 struct spi_message *m; 287 struct spi_device *spi; 288 struct spi_transfer *t = NULL; 289 int par_override = 0; 290 int status = 0; 291 int cs_active = 0; 292 293 m = container_of(orion_spi->msg_queue.next, struct spi_message, 294 queue); 295 296 list_del_init(&m->queue); 297 spin_unlock_irq(&orion_spi->lock); 298 299 spi = m->spi; 300 301 /* Load defaults */ 302 status = orion_spi_setup_transfer(spi, NULL); 303 304 if (status < 0) 305 goto msg_done; 306 307 list_for_each_entry(t, &m->transfers, transfer_list) { 308 if (par_override || t->speed_hz || t->bits_per_word) { 309 par_override = 1; 310 status = orion_spi_setup_transfer(spi, t); 311 if (status < 0) 312 break; 313 if (!t->speed_hz && !t->bits_per_word) 314 par_override = 0; 315 } 316 317 if (!cs_active) { 318 orion_spi_set_cs(orion_spi, 1); 319 cs_active = 1; 320 } 321 322 if (t->len) 323 m->actual_length += 324 orion_spi_write_read(spi, t); 325 326 if (t->delay_usecs) 327 udelay(t->delay_usecs); 328 329 if (t->cs_change) { 330 orion_spi_set_cs(orion_spi, 0); 331 cs_active = 0; 332 } 333 } 334 335 msg_done: 336 if (cs_active) 337 orion_spi_set_cs(orion_spi, 0); 338 339 m->status = status; 340 m->complete(m->context); 341 342 spin_lock_irq(&orion_spi->lock); 343 } 344 345 spin_unlock_irq(&orion_spi->lock); 346 } 347 348 static int __init orion_spi_reset(struct orion_spi *orion_spi) 349 { 350 /* Verify that the CS is deasserted */ 351 orion_spi_set_cs(orion_spi, 0); 352 353 return 0; 354 } 355 356 static int orion_spi_setup(struct spi_device *spi) 357 { 358 struct orion_spi *orion_spi; 359 360 orion_spi = spi_master_get_devdata(spi->master); 361 362 if ((spi->max_speed_hz == 0) 363 || (spi->max_speed_hz > orion_spi->max_speed)) 364 spi->max_speed_hz = orion_spi->max_speed; 365 366 if (spi->max_speed_hz < orion_spi->min_speed) { 367 dev_err(&spi->dev, "setup: requested speed too low %d Hz\n", 368 spi->max_speed_hz); 369 return -EINVAL; 370 } 371 372 /* 373 * baudrate & width will be set orion_spi_setup_transfer 374 */ 375 return 0; 376 } 377 378 static int orion_spi_transfer(struct spi_device *spi, struct spi_message *m) 379 { 380 struct orion_spi *orion_spi; 381 struct spi_transfer *t = NULL; 382 unsigned long flags; 383 384 m->actual_length = 0; 385 m->status = 0; 386 387 /* reject invalid messages and transfers */ 388 if (list_empty(&m->transfers) || !m->complete) 389 return -EINVAL; 390 391 orion_spi = spi_master_get_devdata(spi->master); 392 393 list_for_each_entry(t, &m->transfers, transfer_list) { 394 unsigned int bits_per_word = spi->bits_per_word; 395 396 if (t->tx_buf == NULL && t->rx_buf == NULL && t->len) { 397 dev_err(&spi->dev, 398 "message rejected : " 399 "invalid transfer data buffers\n"); 400 goto msg_rejected; 401 } 402 403 if (t->bits_per_word) 404 bits_per_word = t->bits_per_word; 405 406 if ((bits_per_word != 8) && (bits_per_word != 16)) { 407 dev_err(&spi->dev, 408 "message rejected : " 409 "invalid transfer bits_per_word (%d bits)\n", 410 bits_per_word); 411 goto msg_rejected; 412 } 413 /*make sure buffer length is even when working in 16 bit mode*/ 414 if ((t->bits_per_word == 16) && (t->len & 1)) { 415 dev_err(&spi->dev, 416 "message rejected : " 417 "odd data length (%d) while in 16 bit mode\n", 418 t->len); 419 goto msg_rejected; 420 } 421 422 if (t->speed_hz && t->speed_hz < orion_spi->min_speed) { 423 dev_err(&spi->dev, 424 "message rejected : " 425 "device min speed (%d Hz) exceeds " 426 "required transfer speed (%d Hz)\n", 427 orion_spi->min_speed, t->speed_hz); 428 goto msg_rejected; 429 } 430 } 431 432 433 spin_lock_irqsave(&orion_spi->lock, flags); 434 list_add_tail(&m->queue, &orion_spi->msg_queue); 435 queue_work(orion_spi_wq, &orion_spi->work); 436 spin_unlock_irqrestore(&orion_spi->lock, flags); 437 438 return 0; 439 msg_rejected: 440 /* Message rejected and not queued */ 441 m->status = -EINVAL; 442 if (m->complete) 443 m->complete(m->context); 444 return -EINVAL; 445 } 446 447 static int __init orion_spi_probe(struct platform_device *pdev) 448 { 449 struct spi_master *master; 450 struct orion_spi *spi; 451 struct resource *r; 452 struct orion_spi_info *spi_info; 453 int status = 0; 454 455 spi_info = pdev->dev.platform_data; 456 457 master = spi_alloc_master(&pdev->dev, sizeof *spi); 458 if (master == NULL) { 459 dev_dbg(&pdev->dev, "master allocation failed\n"); 460 return -ENOMEM; 461 } 462 463 if (pdev->id != -1) 464 master->bus_num = pdev->id; 465 466 /* we support only mode 0, and no options */ 467 master->mode_bits = 0; 468 469 master->setup = orion_spi_setup; 470 master->transfer = orion_spi_transfer; 471 master->num_chipselect = ORION_NUM_CHIPSELECTS; 472 473 dev_set_drvdata(&pdev->dev, master); 474 475 spi = spi_master_get_devdata(master); 476 spi->master = master; 477 spi->spi_info = spi_info; 478 479 spi->max_speed = DIV_ROUND_UP(spi_info->tclk, 4); 480 spi->min_speed = DIV_ROUND_UP(spi_info->tclk, 30); 481 482 r = platform_get_resource(pdev, IORESOURCE_MEM, 0); 483 if (r == NULL) { 484 status = -ENODEV; 485 goto out; 486 } 487 488 if (!request_mem_region(r->start, resource_size(r), 489 dev_name(&pdev->dev))) { 490 status = -EBUSY; 491 goto out; 492 } 493 spi->base = ioremap(r->start, SZ_1K); 494 495 INIT_WORK(&spi->work, orion_spi_work); 496 497 spin_lock_init(&spi->lock); 498 INIT_LIST_HEAD(&spi->msg_queue); 499 500 if (orion_spi_reset(spi) < 0) 501 goto out_rel_mem; 502 503 status = spi_register_master(master); 504 if (status < 0) 505 goto out_rel_mem; 506 507 return status; 508 509 out_rel_mem: 510 release_mem_region(r->start, resource_size(r)); 511 512 out: 513 spi_master_put(master); 514 return status; 515 } 516 517 518 static int __exit orion_spi_remove(struct platform_device *pdev) 519 { 520 struct spi_master *master; 521 struct orion_spi *spi; 522 struct resource *r; 523 524 master = dev_get_drvdata(&pdev->dev); 525 spi = spi_master_get_devdata(master); 526 527 cancel_work_sync(&spi->work); 528 529 r = platform_get_resource(pdev, IORESOURCE_MEM, 0); 530 release_mem_region(r->start, resource_size(r)); 531 532 spi_unregister_master(master); 533 534 return 0; 535 } 536 537 MODULE_ALIAS("platform:" DRIVER_NAME); 538 539 static struct platform_driver orion_spi_driver = { 540 .driver = { 541 .name = DRIVER_NAME, 542 .owner = THIS_MODULE, 543 }, 544 .remove = __exit_p(orion_spi_remove), 545 }; 546 547 static int __init orion_spi_init(void) 548 { 549 orion_spi_wq = create_singlethread_workqueue( 550 orion_spi_driver.driver.name); 551 if (orion_spi_wq == NULL) 552 return -ENOMEM; 553 554 return platform_driver_probe(&orion_spi_driver, orion_spi_probe); 555 } 556 module_init(orion_spi_init); 557 558 static void __exit orion_spi_exit(void) 559 { 560 flush_workqueue(orion_spi_wq); 561 platform_driver_unregister(&orion_spi_driver); 562 563 destroy_workqueue(orion_spi_wq); 564 } 565 module_exit(orion_spi_exit); 566 567 MODULE_DESCRIPTION("Orion SPI driver"); 568 MODULE_AUTHOR("Shadi Ammouri <shadi@marvell.com>"); 569 MODULE_LICENSE("GPL"); 570