SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/spi/spi_bitbang.c

   1 /*
   2  * spi_bitbang.c - polling/bitbanging SPI master controller driver utilities
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with this program; if not, write to the Free Software
  16  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  17  */
  18
  19 #include <linux/init.h>
  20 #include <linux/spinlock.h>
  21 #include <linux/workqueue.h>
  22 #include <linux/interrupt.h>
  23 #include <linux/delay.h>
  24 #include <linux/errno.h>
  25 #include <linux/platform_device.h>
  26
  27 #include <linux/spi/spi.h>
  28 #include <linux/spi/spi_bitbang.h>
  29
  30
  31 /*----------------------------------------------------------------------*/
  32
  33 /*
  34  * FIRST PART (OPTIONAL):  word-at-a-time spi_transfer support.
  35  * Use this for GPIO or shift-register level hardware APIs.
  36  *
  37  * spi_bitbang_cs is in spi_device->controller_state, which is unavailable
  38  * to glue code.  These bitbang setup() and cleanup() routines are always
  39  * used, though maybe they're called from controller-aware code.
  40  *
  41  * chipselect() and friends may use use spi_device->controller_data and
  42  * controller registers as appropriate.
  43  *
  44  *
  45  * NOTE:  SPI controller pins can often be used as GPIO pins instead,
  46  * which means you could use a bitbang driver either to get hardware
  47  * working quickly, or testing for differences that aren't speed related.
  48  */
  49
  50 struct spi_bitbang_cs {
  51         unsigned        nsecs;  /* (clock cycle time)/2 */
  52         u32             (*txrx_word)(struct spi_device *spi, unsigned nsecs,
  53                                         u32 word, u8 bits);
  54         unsigned        (*txrx_bufs)(struct spi_device *,
  55                                         u32 (*txrx_word)(
  56                                                 struct spi_device *spi,
  57                                                 unsigned nsecs,
  58                                                 u32 word, u8 bits),
  59                                         unsigned, struct spi_transfer *);
  60 };
  61
  62 static unsigned bitbang_txrx_8(
  63         struct spi_device       *spi,
  64         u32                     (*txrx_word)(struct spi_device *spi,
  65                                         unsigned nsecs,
  66                                         u32 word, u8 bits),
  67         unsigned                ns,
  68         struct spi_transfer     *t
  69 ) {
  70         unsigned                bits = spi->bits_per_word;
  71         unsigned                count = t->len;
  72         const u8                *tx = t->tx_buf;
  73         u8                      *rx = t->rx_buf;
  74
  75         while (likely(count > 0)) {
  76                 u8              word = 0;
  77
  78                 if (tx)
  79                         word = *tx++;
  80                 word = txrx_word(spi, ns, word, bits);
  81                 if (rx)
  82                         *rx++ = word;
  83                 count -= 1;
  84         }
  85         return t->len - count;
  86 }
  87
  88 static unsigned bitbang_txrx_16(
  89         struct spi_device       *spi,
  90         u32                     (*txrx_word)(struct spi_device *spi,
  91                                         unsigned nsecs,
  92                                         u32 word, u8 bits),
  93         unsigned                ns,
  94         struct spi_transfer     *t
  95 ) {
  96         unsigned                bits = spi->bits_per_word;
  97         unsigned                count = t->len;
  98         const u16               *tx = t->tx_buf;
  99         u16                     *rx = t->rx_buf;
 100
 101         while (likely(count > 1)) {
 102                 u16             word = 0;
 103
 104                 if (tx)
 105                         word = *tx++;
 106                 word = txrx_word(spi, ns, word, bits);
 107                 if (rx)
 108                         *rx++ = word;
 109                 count -= 2;
 110         }
 111         return t->len - count;
 112 }
 113
 114 static unsigned bitbang_txrx_32(
 115         struct spi_device       *spi,
 116         u32                     (*txrx_word)(struct spi_device *spi,
 117                                         unsigned nsecs,
 118                                         u32 word, u8 bits),
 119         unsigned                ns,
 120         struct spi_transfer     *t
 121 ) {
 122         unsigned                bits = spi->bits_per_word;
 123         unsigned                count = t->len;
 124         const u32               *tx = t->tx_buf;
 125         u32                     *rx = t->rx_buf;
 126
 127         while (likely(count > 3)) {
 128                 u32             word = 0;
 129
 130                 if (tx)
 131                         word = *tx++;
 132                 word = txrx_word(spi, ns, word, bits);
 133                 if (rx)
 134                         *rx++ = word;
 135                 count -= 4;
 136         }
 137         return t->len - count;
 138 }
 139
 140 int spi_bitbang_setup_transfer(struct spi_device *spi, struct spi_transfer *t)
 141 {
 142         struct spi_bitbang_cs   *cs = spi->controller_state;
 143         u8                      bits_per_word;
 144         u32                     hz;
 145
 146         if (t) {
 147                 bits_per_word = t->bits_per_word;
 148                 hz = t->speed_hz;
 149         } else {
 150                 bits_per_word = 0;
 151                 hz = 0;
 152         }
 153
 154         /* spi_transfer level calls that work per-word */
 155         if (!bits_per_word)
 156                 bits_per_word = spi->bits_per_word;
 157         if (bits_per_word <= 8)
 158                 cs->txrx_bufs = bitbang_txrx_8;
 159         else if (bits_per_word <= 16)
 160                 cs->txrx_bufs = bitbang_txrx_16;
 161         else if (bits_per_word <= 32)
 162                 cs->txrx_bufs = bitbang_txrx_32;
 163         else
 164                 return -EINVAL;
 165
 166         /* nsecs = (clock period)/2 */
 167         if (!hz)
 168                 hz = spi->max_speed_hz;
 169         if (hz) {
 170                 cs->nsecs = (1000000000/2) / hz;
 171                 if (cs->nsecs > (MAX_UDELAY_MS * 1000 * 1000))
 172                         return -EINVAL;
 173         }
 174
 175         return 0;
 176 }
 177 EXPORT_SYMBOL_GPL(spi_bitbang_setup_transfer);
 178
 179 /**
 180  * spi_bitbang_setup - default setup for per-word I/O loops
 181  */
 182 int spi_bitbang_setup(struct spi_device *spi)
 183 {
 184         struct spi_bitbang_cs   *cs = spi->controller_state;
 185         struct spi_bitbang      *bitbang;
 186         int                     retval;
 187         unsigned long           flags;
 188
 189         bitbang = spi_master_get_devdata(spi->master);
 190
 191         /* Bitbangers can support SPI_CS_HIGH, SPI_3WIRE, and so on;
 192          * add those to master->flags, and provide the other support.
 193          */
 194         if ((spi->mode & ~(SPI_CPOL|SPI_CPHA|bitbang->flags)) != 0)
 195                 return -EINVAL;
 196
 197         if (!cs) {
 198                 cs = kzalloc(sizeof *cs, GFP_KERNEL);
 199                 if (!cs)
 200                         return -ENOMEM;
 201                 spi->controller_state = cs;
 202         }
 203
 204         /* per-word shift register access, in hardware or bitbanging */
 205         cs->txrx_word = bitbang->txrx_word[spi->mode & (SPI_CPOL|SPI_CPHA)];
 206         if (!cs->txrx_word)
 207                 return -EINVAL;
 208
 209         retval = bitbang->setup_transfer(spi, NULL);
 210         if (retval < 0)
 211                 return retval;
 212
 213         dev_dbg(&spi->dev, "%s, %u nsec/bit\n", __func__, 2 * cs->nsecs);
 214
 215         /* NOTE we _need_ to call chipselect() early, ideally with adapter
 216          * setup, unless the hardware defaults cooperate to avoid confusion
 217          * between normal (active low) and inverted chipselects.
 218          */
 219
 220         /* deselect chip (low or high) */
 221         spin_lock_irqsave(&bitbang->lock, flags);
 222         if (!bitbang->busy) {
 223                 bitbang->chipselect(spi, BITBANG_CS_INACTIVE);
 224                 ndelay(cs->nsecs);
 225         }
 226         spin_unlock_irqrestore(&bitbang->lock, flags);
 227
 228         return 0;
 229 }
 230 EXPORT_SYMBOL_GPL(spi_bitbang_setup);
 231
 232 /**
 233  * spi_bitbang_cleanup - default cleanup for per-word I/O loops
 234  */
 235 void spi_bitbang_cleanup(struct spi_device *spi)
 236 {
 237         kfree(spi->controller_state);
 238 }
 239 EXPORT_SYMBOL_GPL(spi_bitbang_cleanup);
 240
 241 static int spi_bitbang_bufs(struct spi_device *spi, struct spi_transfer *t)
 242 {
 243         struct spi_bitbang_cs   *cs = spi->controller_state;
 244         unsigned                nsecs = cs->nsecs;
 245
 246         return cs->txrx_bufs(spi, cs->txrx_word, nsecs, t);
 247 }
 248
 249 /*----------------------------------------------------------------------*/
 250
 251 /*
 252  * SECOND PART ... simple transfer queue runner.
 253  *
 254  * This costs a task context per controller, running the queue by
 255  * performing each transfer in sequence.  Smarter hardware can queue
 256  * several DMA transfers at once, and process several controller queues
 257  * in parallel; this driver doesn't match such hardware very well.
 258  *
 259  * Drivers can provide word-at-a-time i/o primitives, or provide
 260  * transfer-at-a-time ones to leverage dma or fifo hardware.
 261  */
 262 static void bitbang_work(struct work_struct *work)
 263 {
 264         struct spi_bitbang      *bitbang =
 265                 container_of(work, struct spi_bitbang, work);
 266         unsigned long           flags;
 267
 268         spin_lock_irqsave(&bitbang->lock, flags);
 269         bitbang->busy = 1;
 270         while (!list_empty(&bitbang->queue)) {
 271                 struct spi_message      *m;
 272                 struct spi_device       *spi;
 273                 unsigned                nsecs;
 274                 struct spi_transfer     *t = NULL;
 275                 unsigned                tmp;
 276                 unsigned                cs_change;
 277                 int                     status;
 278                 int                     (*setup_transfer)(struct spi_device *,
 279                                                 struct spi_transfer *);
 280
 281                 m = container_of(bitbang->queue.next, struct spi_message,
 282                                 queue);
 283                 list_del_init(&m->queue);
 284                 spin_unlock_irqrestore(&bitbang->lock, flags);
 285
 286                 /* FIXME this is made-up ... the correct value is known to
 287                  * word-at-a-time bitbang code, and presumably chipselect()
 288                  * should enforce these requirements too?
 289                  */
 290                 nsecs = 100;
 291
 292                 spi = m->spi;
 293                 tmp = 0;
 294                 cs_change = 1;
 295                 status = 0;
 296                 setup_transfer = NULL;
 297
 298                 list_for_each_entry (t, &m->transfers, transfer_list) {
 299
 300                         /* override or restore speed and wordsize */
 301                         if (t->speed_hz || t->bits_per_word) {
 302                                 setup_transfer = bitbang->setup_transfer;
 303                                 if (!setup_transfer) {
 304                                         status = -ENOPROTOOPT;
 305                                         break;
 306                                 }
 307                         }
 308                         if (setup_transfer) {
 309                                 status = setup_transfer(spi, t);
 310                                 if (status < 0)
 311                                         break;
 312                         }
 313
 314                         /* set up default clock polarity, and activate chip;
 315                          * this implicitly updates clock and spi modes as
 316                          * previously recorded for this device via setup().
 317                          * (and also deselects any other chip that might be
 318                          * selected ...)
 319                          */
 320                         if (cs_change) {
 321                                 bitbang->chipselect(spi, BITBANG_CS_ACTIVE);
 322                                 ndelay(nsecs);
 323                         }
 324                         cs_change = t->cs_change;
 325                         if (!t->tx_buf && !t->rx_buf && t->len) {
 326                                 status = -EINVAL;
 327                                 break;
 328                         }
 329
 330                         /* transfer data.  the lower level code handles any
 331                          * new dma mappings it needs. our caller always gave
 332                          * us dma-safe buffers.
 333                          */
 334                         if (t->len) {
 335                                 /* REVISIT dma API still needs a designated
 336                                  * DMA_ADDR_INVALID; ~0 might be better.
 337                                  */
 338                                 if (!m->is_dma_mapped)
 339                                         t->rx_dma = t->tx_dma = 0;
 340                                 status = bitbang->txrx_bufs(spi, t);
 341                         }
 342                         if (status > 0)
 343                                 m->actual_length += status;
 344                         if (status != t->len) {
 345                                 /* always report some kind of error */
 346                                 if (status >= 0)
 347                                         status = -EREMOTEIO;
 348                                 break;
 349                         }
 350                         status = 0;
 351
 352                         /* protocol tweaks before next transfer */
 353                         if (t->delay_usecs)
 354                                 udelay(t->delay_usecs);
 355
 356                         if (!cs_change)
 357                                 continue;
 358                         if (t->transfer_list.next == &m->transfers)
 359                                 break;
 360
 361                         /* sometimes a short mid-message deselect of the chip
 362                          * may be needed to terminate a mode or command
 363                          */
 364                         ndelay(nsecs);
 365                         bitbang->chipselect(spi, BITBANG_CS_INACTIVE);
 366                         ndelay(nsecs);
 367                 }
 368
 369                 m->status = status;
 370                 m->complete(m->context);
 371
 372                 /* restore speed and wordsize */
 373                 if (setup_transfer)
 374                         setup_transfer(spi, NULL);
 375
 376                 /* normally deactivate chipselect ... unless no error and
 377                  * cs_change has hinted that the next message will probably
 378                  * be for this chip too.
 379                  */
 380                 if (!(status == 0 && cs_change)) {
 381                         ndelay(nsecs);
 382                         bitbang->chipselect(spi, BITBANG_CS_INACTIVE);
 383                         ndelay(nsecs);
 384                 }
 385
 386                 spin_lock_irqsave(&bitbang->lock, flags);
 387         }
 388         bitbang->busy = 0;
 389         spin_unlock_irqrestore(&bitbang->lock, flags);
 390 }
 391
 392 /**
 393  * spi_bitbang_transfer - default submit to transfer queue
 394  */
 395 int spi_bitbang_transfer(struct spi_device *spi, struct spi_message *m)
 396 {
 397         struct spi_bitbang      *bitbang;
 398         unsigned long           flags;
 399         int                     status = 0;
 400
 401         m->actual_length = 0;
 402         m->status = -EINPROGRESS;
 403
 404         bitbang = spi_master_get_devdata(spi->master);
 405
 406         spin_lock_irqsave(&bitbang->lock, flags);
 407         if (!spi->max_speed_hz)
 408                 status = -ENETDOWN;
 409         else {
 410                 list_add_tail(&m->queue, &bitbang->queue);
 411                 queue_work(bitbang->workqueue, &bitbang->work);
 412         }
 413         spin_unlock_irqrestore(&bitbang->lock, flags);
 414
 415         return status;
 416 }
 417 EXPORT_SYMBOL_GPL(spi_bitbang_transfer);
 418
 419 /*----------------------------------------------------------------------*/
 420
 421 /**
 422  * spi_bitbang_start - start up a polled/bitbanging SPI master driver
 423  * @bitbang: driver handle
 424  *
 425  * Caller should have zero-initialized all parts of the structure, and then
 426  * provided callbacks for chip selection and I/O loops.  If the master has
 427  * a transfer method, its final step should call spi_bitbang_transfer; or,
 428  * that's the default if the transfer routine is not initialized.  It should
 429  * also set up the bus number and number of chipselects.
 430  *
 431  * For i/o loops, provide callbacks either per-word (for bitbanging, or for
 432  * hardware that basically exposes a shift register) or per-spi_transfer
 433  * (which takes better advantage of hardware like fifos or DMA engines).
 434  *
 435  * Drivers using per-word I/O loops should use (or call) spi_bitbang_setup,
 436  * spi_bitbang_cleanup and spi_bitbang_setup_transfer to handle those spi
 437  * master methods.  Those methods are the defaults if the bitbang->txrx_bufs
 438  * routine isn't initialized.
 439  *
 440  * This routine registers the spi_master, which will process requests in a
 441  * dedicated task, keeping IRQs unblocked most of the time.  To stop
 442  * processing those requests, call spi_bitbang_stop().
 443  */
 444 int spi_bitbang_start(struct spi_bitbang *bitbang)
 445 {
 446         int     status;
 447
 448         if (!bitbang->master || !bitbang->chipselect)
 449                 return -EINVAL;
 450
 451         INIT_WORK(&bitbang->work, bitbang_work);
 452         spin_lock_init(&bitbang->lock);
 453         INIT_LIST_HEAD(&bitbang->queue);
 454
 455         if (!bitbang->master->transfer)
 456                 bitbang->master->transfer = spi_bitbang_transfer;
 457         if (!bitbang->txrx_bufs) {
 458                 bitbang->use_dma = 0;
 459                 bitbang->txrx_bufs = spi_bitbang_bufs;
 460                 if (!bitbang->master->setup) {
 461                         if (!bitbang->setup_transfer)
 462                                 bitbang->setup_transfer =
 463                                          spi_bitbang_setup_transfer;
 464                         bitbang->master->setup = spi_bitbang_setup;
 465                         bitbang->master->cleanup = spi_bitbang_cleanup;
 466                 }
 467         } else if (!bitbang->master->setup)
 468                 return -EINVAL;
 469
 470         /* this task is the only thing to touch the SPI bits */
 471         bitbang->busy = 0;
 472         bitbang->workqueue = create_singlethread_workqueue(
 473                         dev_name(bitbang->master->dev.parent));
 474         if (bitbang->workqueue == NULL) {
 475                 status = -EBUSY;
 476                 goto err1;
 477         }
 478
 479         /* driver may get busy before register() returns, especially
 480          * if someone registered boardinfo for devices
 481          */
 482         status = spi_register_master(bitbang->master);
 483         if (status < 0)
 484                 goto err2;
 485
 486         return status;
 487
 488 err2:
 489         destroy_workqueue(bitbang->workqueue);
 490 err1:
 491         return status;
 492 }
 493 EXPORT_SYMBOL_GPL(spi_bitbang_start);
 494
 495 /**
 496  * spi_bitbang_stop - stops the task providing spi communication
 497  */
 498 int spi_bitbang_stop(struct spi_bitbang *bitbang)
 499 {
 500         spi_unregister_master(bitbang->master);
 501
 502         WARN_ON(!list_empty(&bitbang->queue));
 503
 504         destroy_workqueue(bitbang->workqueue);
 505
 506         return 0;
 507 }
 508 EXPORT_SYMBOL_GPL(spi_bitbang_stop);
 509
 510 MODULE_LICENSE("GPL");
 511