Home | History | Annotate | Line # | Download | only in spi
spi.c revision 1.3
      1  1.3  xtraeme /* $NetBSD: spi.c,v 1.3 2008/05/04 14:21:56 xtraeme Exp $ */
      2  1.1  gdamore 
      3  1.1  gdamore /*-
      4  1.1  gdamore  * Copyright (c) 2006 Urbana-Champaign Independent Media Center.
      5  1.1  gdamore  * Copyright (c) 2006 Garrett D'Amore.
      6  1.1  gdamore  * All rights reserved.
      7  1.1  gdamore  *
      8  1.1  gdamore  * Portions of this code were written by Garrett D'Amore for the
      9  1.1  gdamore  * Champaign-Urbana Community Wireless Network Project.
     10  1.1  gdamore  *
     11  1.1  gdamore  * Redistribution and use in source and binary forms, with or
     12  1.1  gdamore  * without modification, are permitted provided that the following
     13  1.1  gdamore  * conditions are met:
     14  1.1  gdamore  * 1. Redistributions of source code must retain the above copyright
     15  1.1  gdamore  *    notice, this list of conditions and the following disclaimer.
     16  1.1  gdamore  * 2. Redistributions in binary form must reproduce the above
     17  1.1  gdamore  *    copyright notice, this list of conditions and the following
     18  1.1  gdamore  *    disclaimer in the documentation and/or other materials provided
     19  1.1  gdamore  *    with the distribution.
     20  1.1  gdamore  * 3. All advertising materials mentioning features or use of this
     21  1.1  gdamore  *    software must display the following acknowledgements:
     22  1.1  gdamore  *      This product includes software developed by the Urbana-Champaign
     23  1.1  gdamore  *      Independent Media Center.
     24  1.1  gdamore  *	This product includes software developed by Garrett D'Amore.
     25  1.1  gdamore  * 4. Urbana-Champaign Independent Media Center's name and Garrett
     26  1.1  gdamore  *    D'Amore's name may not be used to endorse or promote products
     27  1.1  gdamore  *    derived from this software without specific prior written permission.
     28  1.1  gdamore  *
     29  1.1  gdamore  * THIS SOFTWARE IS PROVIDED BY THE URBANA-CHAMPAIGN INDEPENDENT
     30  1.1  gdamore  * MEDIA CENTER AND GARRETT D'AMORE ``AS IS'' AND ANY EXPRESS OR
     31  1.1  gdamore  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     32  1.1  gdamore  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     33  1.1  gdamore  * ARE DISCLAIMED.  IN NO EVENT SHALL THE URBANA-CHAMPAIGN INDEPENDENT
     34  1.1  gdamore  * MEDIA CENTER OR GARRETT D'AMORE BE LIABLE FOR ANY DIRECT, INDIRECT,
     35  1.1  gdamore  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     36  1.1  gdamore  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     37  1.1  gdamore  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
     38  1.1  gdamore  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     39  1.1  gdamore  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     40  1.1  gdamore  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
     41  1.1  gdamore  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     42  1.1  gdamore  */
     43  1.1  gdamore 
     44  1.1  gdamore #include <sys/cdefs.h>
     45  1.3  xtraeme __KERNEL_RCSID(0, "$NetBSD: spi.c,v 1.3 2008/05/04 14:21:56 xtraeme Exp $");
     46  1.1  gdamore 
     47  1.1  gdamore #include "locators.h"
     48  1.1  gdamore 
     49  1.1  gdamore #include <sys/param.h>
     50  1.1  gdamore #include <sys/systm.h>
     51  1.1  gdamore #include <sys/device.h>
     52  1.1  gdamore #include <sys/malloc.h>
     53  1.1  gdamore #include <sys/proc.h>
     54  1.1  gdamore #include <sys/errno.h>
     55  1.1  gdamore 
     56  1.1  gdamore #include <dev/spi/spivar.h>
     57  1.1  gdamore 
     58  1.1  gdamore struct spi_softc {
     59  1.1  gdamore 	struct spi_controller	sc_controller;
     60  1.1  gdamore 	int			sc_mode;
     61  1.1  gdamore 	int			sc_speed;
     62  1.1  gdamore 	int			sc_nslaves;
     63  1.1  gdamore 	struct spi_handle	*sc_slaves;
     64  1.1  gdamore };
     65  1.1  gdamore 
     66  1.1  gdamore /*
     67  1.1  gdamore  * SPI slave device.  We have one of these per slave.
     68  1.1  gdamore  */
     69  1.1  gdamore struct spi_handle {
     70  1.1  gdamore 	struct spi_softc	*sh_sc;
     71  1.1  gdamore 	struct spi_controller	*sh_controller;
     72  1.1  gdamore 	int			sh_slave;
     73  1.1  gdamore };
     74  1.1  gdamore 
     75  1.1  gdamore /*
     76  1.1  gdamore  * API for bus drivers.
     77  1.1  gdamore  */
     78  1.1  gdamore 
     79  1.1  gdamore int
     80  1.1  gdamore spibus_print(void *aux, const char *pnp)
     81  1.1  gdamore {
     82  1.1  gdamore 
     83  1.1  gdamore 	if (pnp != NULL)
     84  1.1  gdamore 		aprint_normal("spi at %s", pnp);
     85  1.1  gdamore 
     86  1.1  gdamore 	return (UNCONF);
     87  1.1  gdamore }
     88  1.1  gdamore 
     89  1.1  gdamore 
     90  1.1  gdamore static int
     91  1.3  xtraeme spi_match(device_t parent, cfdata_t cf, void *aux)
     92  1.1  gdamore {
     93  1.1  gdamore 
     94  1.1  gdamore 	return 1;
     95  1.1  gdamore }
     96  1.1  gdamore 
     97  1.1  gdamore static int
     98  1.1  gdamore spi_print(void *aux, const char *pnp)
     99  1.1  gdamore {
    100  1.1  gdamore 	struct spi_attach_args *sa = aux;
    101  1.1  gdamore 
    102  1.1  gdamore 	if (sa->sa_handle->sh_slave != -1)
    103  1.1  gdamore 		aprint_normal(" slave %d", sa->sa_handle->sh_slave);
    104  1.1  gdamore 
    105  1.1  gdamore 	return (UNCONF);
    106  1.1  gdamore }
    107  1.1  gdamore 
    108  1.1  gdamore static int
    109  1.3  xtraeme spi_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
    110  1.1  gdamore {
    111  1.3  xtraeme 	struct spi_softc *sc = device_private(parent);
    112  1.1  gdamore 	struct spi_attach_args sa;
    113  1.1  gdamore 	int addr;
    114  1.1  gdamore 
    115  1.1  gdamore 	addr = cf->cf_loc[SPICF_SLAVE];
    116  1.1  gdamore 	if ((addr < 0) || (addr >= sc->sc_controller.sct_nslaves)) {
    117  1.1  gdamore 		return -1;
    118  1.1  gdamore 	}
    119  1.1  gdamore 
    120  1.1  gdamore 	sa.sa_handle = &sc->sc_slaves[addr];
    121  1.1  gdamore 
    122  1.1  gdamore 	if (config_match(parent, cf, &sa) > 0)
    123  1.1  gdamore 		config_attach(parent, cf, &sa, spi_print);
    124  1.1  gdamore 
    125  1.1  gdamore 	return 0;
    126  1.1  gdamore }
    127  1.1  gdamore 
    128  1.1  gdamore /*
    129  1.1  gdamore  * API for device drivers.
    130  1.1  gdamore  *
    131  1.1  gdamore  * We provide wrapper routines to decouple the ABI for the SPI
    132  1.1  gdamore  * device drivers from the ABI for the SPI bus drivers.
    133  1.1  gdamore  */
    134  1.1  gdamore static void
    135  1.3  xtraeme spi_attach(device_t parent, device_t self, void *aux)
    136  1.1  gdamore {
    137  1.1  gdamore 	struct spi_softc *sc = device_private(self);
    138  1.1  gdamore 	struct spibus_attach_args *sba = aux;
    139  1.1  gdamore 	int i;
    140  1.1  gdamore 
    141  1.1  gdamore 	aprint_naive(": SPI bus\n");
    142  1.1  gdamore 	aprint_normal(": SPI bus\n");
    143  1.1  gdamore 
    144  1.1  gdamore 	sc->sc_controller = *sba->sba_controller;
    145  1.1  gdamore 	/* allocate slave structures */
    146  1.1  gdamore 	sc->sc_slaves = malloc(sizeof (struct spi_handle) * sc->sc_nslaves,
    147  1.1  gdamore 	    M_DEVBUF, M_WAITOK | M_ZERO);
    148  1.1  gdamore 
    149  1.1  gdamore 	sc->sc_speed = 0;
    150  1.2  gdamore 	sc->sc_mode = -1;
    151  1.1  gdamore 
    152  1.1  gdamore 	/*
    153  1.1  gdamore 	 * Initialize slave handles
    154  1.1  gdamore 	 */
    155  1.1  gdamore 	sc->sc_nslaves = sba->sba_controller->sct_nslaves;
    156  1.1  gdamore 	for (i = 0; i < sc->sc_nslaves; i++) {
    157  1.1  gdamore 		sc->sc_slaves[i].sh_slave = i;
    158  1.1  gdamore 		sc->sc_slaves[i].sh_sc = sc;
    159  1.1  gdamore 		sc->sc_slaves[i].sh_controller = &sc->sc_controller;
    160  1.1  gdamore 	}
    161  1.1  gdamore 
    162  1.1  gdamore 	/*
    163  1.1  gdamore 	 * Locate and attach child devices
    164  1.1  gdamore 	 */
    165  1.1  gdamore 	config_search_ia(spi_search, self, "spi", NULL);
    166  1.1  gdamore }
    167  1.1  gdamore 
    168  1.3  xtraeme CFATTACH_DECL_NEW(spi, sizeof(struct spi_softc),
    169  1.1  gdamore     spi_match, spi_attach, NULL, NULL);
    170  1.1  gdamore 
    171  1.1  gdamore /*
    172  1.1  gdamore  * Configure.  This should be the first thing that the SPI driver
    173  1.1  gdamore  * should do, to configure which mode (e.g. SPI_MODE_0, which is the
    174  1.1  gdamore  * same as Philips Microwire mode), and speed.  If the bus driver
    175  1.1  gdamore  * cannot run fast enough, then it should just configure the fastest
    176  1.1  gdamore  * mode that it can support.  If the bus driver cannot run slow
    177  1.1  gdamore  * enough, then the device is incompatible and an error should be
    178  1.1  gdamore  * returned.
    179  1.1  gdamore  */
    180  1.1  gdamore int
    181  1.1  gdamore spi_configure(struct spi_handle *sh, int mode, int speed)
    182  1.1  gdamore {
    183  1.1  gdamore 	int			s, rv;
    184  1.1  gdamore 	struct spi_softc	*sc = sh->sh_sc;
    185  1.1  gdamore 	struct spi_controller	*tag = sh->sh_controller;
    186  1.1  gdamore 
    187  1.1  gdamore 	/* ensure that request is compatible with other devices on the bus */
    188  1.1  gdamore 	if ((sc->sc_mode >= 0) && (sc->sc_mode != mode))
    189  1.1  gdamore 		return EINVAL;
    190  1.1  gdamore 
    191  1.1  gdamore 	s = splserial();
    192  1.1  gdamore 	/* pick lowest configured speed */
    193  1.1  gdamore 	if (speed == 0)
    194  1.1  gdamore 		speed = sc->sc_speed;
    195  1.1  gdamore 	if (sc->sc_speed)
    196  1.1  gdamore 		speed = min(sc->sc_speed, speed);
    197  1.1  gdamore 
    198  1.1  gdamore 	rv = (*tag->sct_configure)(tag->sct_cookie, sh->sh_slave,
    199  1.1  gdamore 	    mode, speed);
    200  1.1  gdamore 
    201  1.1  gdamore 	if (rv == 0) {
    202  1.1  gdamore 		sc->sc_mode = mode;
    203  1.1  gdamore 		sc->sc_speed = speed;
    204  1.1  gdamore 	}
    205  1.1  gdamore 	splx(s);
    206  1.1  gdamore 	return rv;
    207  1.1  gdamore }
    208  1.1  gdamore 
    209  1.1  gdamore void
    210  1.1  gdamore spi_transfer_init(struct spi_transfer *st)
    211  1.1  gdamore {
    212  1.1  gdamore 
    213  1.1  gdamore 	simple_lock_init(&st->st_lock);
    214  1.1  gdamore 	st->st_flags = 0;
    215  1.1  gdamore 	st->st_errno = 0;
    216  1.1  gdamore 	st->st_done = NULL;
    217  1.1  gdamore 	st->st_chunks = NULL;
    218  1.1  gdamore 	st->st_private = NULL;
    219  1.1  gdamore 	st->st_slave = -1;
    220  1.1  gdamore }
    221  1.1  gdamore 
    222  1.1  gdamore void
    223  1.1  gdamore spi_chunk_init(struct spi_chunk *chunk, int cnt, const uint8_t *wptr,
    224  1.1  gdamore     uint8_t *rptr)
    225  1.1  gdamore {
    226  1.1  gdamore 
    227  1.1  gdamore 	chunk->chunk_write = chunk->chunk_wptr = wptr;
    228  1.1  gdamore 	chunk->chunk_read = chunk->chunk_read = rptr;
    229  1.1  gdamore 	chunk->chunk_rresid = chunk->chunk_wresid = chunk->chunk_count = cnt;
    230  1.1  gdamore 	chunk->chunk_next = NULL;
    231  1.1  gdamore }
    232  1.1  gdamore 
    233  1.1  gdamore void
    234  1.1  gdamore spi_transfer_add(struct spi_transfer *st, struct spi_chunk *chunk)
    235  1.1  gdamore {
    236  1.1  gdamore 	struct spi_chunk **cpp;
    237  1.1  gdamore 
    238  1.1  gdamore 	/* this is an O(n) insert -- perhaps we should use a simpleq? */
    239  1.1  gdamore 	for (cpp = &st->st_chunks; *cpp; cpp = &(*cpp)->chunk_next);
    240  1.1  gdamore 	*cpp = chunk;
    241  1.1  gdamore }
    242  1.1  gdamore 
    243  1.1  gdamore int
    244  1.1  gdamore spi_transfer(struct spi_handle *sh, struct spi_transfer *st)
    245  1.1  gdamore {
    246  1.1  gdamore 	struct spi_controller	*tag = sh->sh_controller;
    247  1.1  gdamore 	struct spi_chunk	*chunk;
    248  1.1  gdamore 
    249  1.1  gdamore 	/*
    250  1.1  gdamore 	 * Initialize "resid" counters and pointers, so that callers
    251  1.1  gdamore 	 * and bus drivers don't have to.
    252  1.1  gdamore 	 */
    253  1.1  gdamore 	for (chunk = st->st_chunks; chunk; chunk = chunk->chunk_next) {
    254  1.1  gdamore 		chunk->chunk_wresid = chunk->chunk_rresid = chunk->chunk_count;
    255  1.1  gdamore 		chunk->chunk_wptr = chunk->chunk_write;
    256  1.1  gdamore 		chunk->chunk_rptr = chunk->chunk_read;
    257  1.1  gdamore 	}
    258  1.1  gdamore 
    259  1.1  gdamore 	/*
    260  1.1  gdamore 	 * Match slave to handle's slave.
    261  1.1  gdamore 	 */
    262  1.1  gdamore 	st->st_slave = sh->sh_slave;
    263  1.1  gdamore 
    264  1.1  gdamore 	return (*tag->sct_transfer)(tag->sct_cookie, st);
    265  1.1  gdamore }
    266  1.1  gdamore 
    267  1.1  gdamore void
    268  1.1  gdamore spi_wait(struct spi_transfer *st)
    269  1.1  gdamore {
    270  1.1  gdamore 	int	s;
    271  1.1  gdamore 
    272  1.1  gdamore 	s = splserial();
    273  1.1  gdamore 	simple_lock(&st->st_lock);
    274  1.1  gdamore 	while (!st->st_flags & SPI_F_DONE) {
    275  1.1  gdamore 		ltsleep(st, PWAIT, "spi_wait", 0, &st->st_lock);
    276  1.1  gdamore 	}
    277  1.1  gdamore 	simple_unlock(&st->st_lock);
    278  1.1  gdamore 	splx(s);
    279  1.1  gdamore }
    280  1.1  gdamore 
    281  1.1  gdamore void
    282  1.1  gdamore spi_done(struct spi_transfer *st, int err)
    283  1.1  gdamore {
    284  1.1  gdamore 	int	s;
    285  1.1  gdamore 
    286  1.1  gdamore 	s = splserial();
    287  1.1  gdamore 
    288  1.1  gdamore 	if ((st->st_errno = err) != 0) {
    289  1.1  gdamore 		st->st_flags |= SPI_F_ERROR;
    290  1.1  gdamore 	}
    291  1.1  gdamore 	st->st_flags |= SPI_F_DONE;
    292  1.1  gdamore 	if (st->st_done != NULL) {
    293  1.1  gdamore 		(*st->st_done)(st);
    294  1.1  gdamore 	} else {
    295  1.1  gdamore 
    296  1.1  gdamore 		simple_lock(&st->st_lock);
    297  1.1  gdamore 		wakeup(st);
    298  1.1  gdamore 		simple_unlock(&st->st_lock);
    299  1.1  gdamore 	}
    300  1.1  gdamore 	splx(s);
    301  1.1  gdamore }
    302  1.1  gdamore 
    303  1.1  gdamore /*
    304  1.1  gdamore  * Some convenience routines.  These routines block until the work
    305  1.1  gdamore  * is done.
    306  1.1  gdamore  *
    307  1.1  gdamore  * spi_recv - receives data from the bus
    308  1.1  gdamore  *
    309  1.1  gdamore  * spi_send - sends data to the bus
    310  1.1  gdamore  *
    311  1.1  gdamore  * spi_send_recv - sends data to the bus, and then receives.  Note that this is
    312  1.1  gdamore  * done synchronously, i.e. send a command and get the response.  This is
    313  1.1  gdamore  * not full duplex.  If you wnat full duplex, you can't use these convenience
    314  1.1  gdamore  * wrappers.
    315  1.1  gdamore  */
    316  1.1  gdamore int
    317  1.1  gdamore spi_recv(struct spi_handle *sh, int cnt, uint8_t *data)
    318  1.1  gdamore {
    319  1.1  gdamore 	struct spi_transfer	trans;
    320  1.1  gdamore 	struct spi_chunk	chunk;
    321  1.1  gdamore 
    322  1.1  gdamore 	spi_transfer_init(&trans);
    323  1.1  gdamore 	spi_chunk_init(&chunk, cnt, NULL, data);
    324  1.1  gdamore 	spi_transfer_add(&trans, &chunk);
    325  1.1  gdamore 
    326  1.1  gdamore 	/* enqueue it and wait for it to complete */
    327  1.1  gdamore 	spi_transfer(sh, &trans);
    328  1.1  gdamore 	spi_wait(&trans);
    329  1.1  gdamore 
    330  1.1  gdamore 	if (trans.st_flags & SPI_F_ERROR)
    331  1.1  gdamore 		return trans.st_errno;
    332  1.1  gdamore 
    333  1.1  gdamore 	return 0;
    334  1.1  gdamore }
    335  1.1  gdamore 
    336  1.1  gdamore int
    337  1.1  gdamore spi_send(struct spi_handle *sh, int cnt, const uint8_t *data)
    338  1.1  gdamore {
    339  1.1  gdamore 	struct spi_transfer	trans;
    340  1.1  gdamore 	struct spi_chunk	chunk;
    341  1.1  gdamore 
    342  1.1  gdamore 	spi_transfer_init(&trans);
    343  1.1  gdamore 	spi_chunk_init(&chunk, cnt, data, NULL);
    344  1.1  gdamore 	spi_transfer_add(&trans, &chunk);
    345  1.1  gdamore 
    346  1.1  gdamore 	/* enqueue it and wait for it to complete */
    347  1.1  gdamore 	spi_transfer(sh, &trans);
    348  1.1  gdamore 	spi_wait(&trans);
    349  1.1  gdamore 
    350  1.1  gdamore 	if (trans.st_flags & SPI_F_ERROR)
    351  1.1  gdamore 		return trans.st_errno;
    352  1.1  gdamore 
    353  1.1  gdamore 	return 0;
    354  1.1  gdamore }
    355  1.1  gdamore 
    356  1.1  gdamore int
    357  1.1  gdamore spi_send_recv(struct spi_handle *sh, int scnt, const uint8_t *snd,
    358  1.1  gdamore     int rcnt, uint8_t *rcv)
    359  1.1  gdamore {
    360  1.1  gdamore 	struct spi_transfer	trans;
    361  1.1  gdamore 	struct spi_chunk	chunk1, chunk2;
    362  1.1  gdamore 
    363  1.1  gdamore 	spi_transfer_init(&trans);
    364  1.1  gdamore 	spi_chunk_init(&chunk1, scnt, snd, NULL);
    365  1.1  gdamore 	spi_chunk_init(&chunk2, rcnt, NULL, rcv);
    366  1.1  gdamore 	spi_transfer_add(&trans, &chunk1);
    367  1.1  gdamore 	spi_transfer_add(&trans, &chunk2);
    368  1.1  gdamore 
    369  1.1  gdamore 	/* enqueue it and wait for it to complete */
    370  1.1  gdamore 	spi_transfer(sh, &trans);
    371  1.1  gdamore 	spi_wait(&trans);
    372  1.1  gdamore 
    373  1.1  gdamore 	if (trans.st_flags & SPI_F_ERROR)
    374  1.1  gdamore 		return trans.st_errno;
    375  1.1  gdamore 
    376  1.1  gdamore 	return 0;
    377  1.1  gdamore }
    378