Home | History | Annotate | Line # | Download | only in spi
spi.c revision 1.3.22.2
      1  1.3.22.1    rmind /* $NetBSD: spi.c,v 1.3.22.2 2011/06/12 00:24:26 rmind 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.22.1    rmind __KERNEL_RCSID(0, "$NetBSD: spi.c,v 1.3.22.2 2011/06/12 00:24:26 rmind 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.3.22.2    rmind #include <sys/mutex.h>
     54  1.3.22.2    rmind #include <sys/condvar.h>
     55       1.1  gdamore #include <sys/errno.h>
     56       1.1  gdamore 
     57       1.1  gdamore #include <dev/spi/spivar.h>
     58       1.1  gdamore 
     59       1.1  gdamore struct spi_softc {
     60       1.1  gdamore 	struct spi_controller	sc_controller;
     61       1.1  gdamore 	int			sc_mode;
     62       1.1  gdamore 	int			sc_speed;
     63       1.1  gdamore 	int			sc_nslaves;
     64       1.1  gdamore 	struct spi_handle	*sc_slaves;
     65       1.1  gdamore };
     66       1.1  gdamore 
     67       1.1  gdamore /*
     68       1.1  gdamore  * SPI slave device.  We have one of these per slave.
     69       1.1  gdamore  */
     70       1.1  gdamore struct spi_handle {
     71       1.1  gdamore 	struct spi_softc	*sh_sc;
     72       1.1  gdamore 	struct spi_controller	*sh_controller;
     73       1.1  gdamore 	int			sh_slave;
     74       1.1  gdamore };
     75       1.1  gdamore 
     76       1.1  gdamore /*
     77       1.1  gdamore  * API for bus drivers.
     78       1.1  gdamore  */
     79       1.1  gdamore 
     80       1.1  gdamore int
     81       1.1  gdamore spibus_print(void *aux, const char *pnp)
     82       1.1  gdamore {
     83       1.1  gdamore 
     84       1.1  gdamore 	if (pnp != NULL)
     85       1.1  gdamore 		aprint_normal("spi at %s", pnp);
     86       1.1  gdamore 
     87       1.1  gdamore 	return (UNCONF);
     88       1.1  gdamore }
     89       1.1  gdamore 
     90       1.1  gdamore 
     91       1.1  gdamore static int
     92       1.3  xtraeme spi_match(device_t parent, cfdata_t cf, void *aux)
     93       1.1  gdamore {
     94  1.3.22.2    rmind 
     95       1.1  gdamore 	return 1;
     96       1.1  gdamore }
     97       1.1  gdamore 
     98       1.1  gdamore static int
     99       1.1  gdamore spi_print(void *aux, const char *pnp)
    100       1.1  gdamore {
    101       1.1  gdamore 	struct spi_attach_args *sa = aux;
    102       1.1  gdamore 
    103       1.1  gdamore 	if (sa->sa_handle->sh_slave != -1)
    104       1.1  gdamore 		aprint_normal(" slave %d", sa->sa_handle->sh_slave);
    105       1.1  gdamore 
    106       1.1  gdamore 	return (UNCONF);
    107       1.1  gdamore }
    108       1.1  gdamore 
    109       1.1  gdamore static int
    110       1.3  xtraeme spi_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
    111       1.1  gdamore {
    112       1.3  xtraeme 	struct spi_softc *sc = device_private(parent);
    113       1.1  gdamore 	struct spi_attach_args sa;
    114       1.1  gdamore 	int addr;
    115       1.1  gdamore 
    116       1.1  gdamore 	addr = cf->cf_loc[SPICF_SLAVE];
    117       1.1  gdamore 	if ((addr < 0) || (addr >= sc->sc_controller.sct_nslaves)) {
    118       1.1  gdamore 		return -1;
    119       1.1  gdamore 	}
    120       1.1  gdamore 
    121       1.1  gdamore 	sa.sa_handle = &sc->sc_slaves[addr];
    122       1.1  gdamore 
    123       1.1  gdamore 	if (config_match(parent, cf, &sa) > 0)
    124       1.1  gdamore 		config_attach(parent, cf, &sa, spi_print);
    125       1.1  gdamore 
    126       1.1  gdamore 	return 0;
    127       1.1  gdamore }
    128       1.1  gdamore 
    129       1.1  gdamore /*
    130       1.1  gdamore  * API for device drivers.
    131       1.1  gdamore  *
    132       1.1  gdamore  * We provide wrapper routines to decouple the ABI for the SPI
    133       1.1  gdamore  * device drivers from the ABI for the SPI bus drivers.
    134       1.1  gdamore  */
    135       1.1  gdamore static void
    136       1.3  xtraeme spi_attach(device_t parent, device_t self, void *aux)
    137       1.1  gdamore {
    138       1.1  gdamore 	struct spi_softc *sc = device_private(self);
    139       1.1  gdamore 	struct spibus_attach_args *sba = aux;
    140       1.1  gdamore 	int i;
    141       1.1  gdamore 
    142       1.1  gdamore 	aprint_naive(": SPI bus\n");
    143       1.1  gdamore 	aprint_normal(": SPI bus\n");
    144       1.1  gdamore 
    145       1.1  gdamore 	sc->sc_controller = *sba->sba_controller;
    146       1.1  gdamore 	/* allocate slave structures */
    147       1.1  gdamore 	sc->sc_slaves = malloc(sizeof (struct spi_handle) * sc->sc_nslaves,
    148       1.1  gdamore 	    M_DEVBUF, M_WAITOK | M_ZERO);
    149       1.1  gdamore 
    150       1.1  gdamore 	sc->sc_speed = 0;
    151       1.2  gdamore 	sc->sc_mode = -1;
    152       1.1  gdamore 
    153       1.1  gdamore 	/*
    154       1.1  gdamore 	 * Initialize slave handles
    155       1.1  gdamore 	 */
    156       1.1  gdamore 	sc->sc_nslaves = sba->sba_controller->sct_nslaves;
    157       1.1  gdamore 	for (i = 0; i < sc->sc_nslaves; i++) {
    158       1.1  gdamore 		sc->sc_slaves[i].sh_slave = i;
    159       1.1  gdamore 		sc->sc_slaves[i].sh_sc = sc;
    160       1.1  gdamore 		sc->sc_slaves[i].sh_controller = &sc->sc_controller;
    161       1.1  gdamore 	}
    162       1.1  gdamore 
    163       1.1  gdamore 	/*
    164       1.1  gdamore 	 * Locate and attach child devices
    165       1.1  gdamore 	 */
    166       1.1  gdamore 	config_search_ia(spi_search, self, "spi", NULL);
    167       1.1  gdamore }
    168       1.1  gdamore 
    169       1.3  xtraeme CFATTACH_DECL_NEW(spi, sizeof(struct spi_softc),
    170       1.1  gdamore     spi_match, spi_attach, NULL, NULL);
    171       1.1  gdamore 
    172       1.1  gdamore /*
    173       1.1  gdamore  * Configure.  This should be the first thing that the SPI driver
    174       1.1  gdamore  * should do, to configure which mode (e.g. SPI_MODE_0, which is the
    175       1.1  gdamore  * same as Philips Microwire mode), and speed.  If the bus driver
    176       1.1  gdamore  * cannot run fast enough, then it should just configure the fastest
    177       1.1  gdamore  * mode that it can support.  If the bus driver cannot run slow
    178       1.1  gdamore  * enough, then the device is incompatible and an error should be
    179       1.1  gdamore  * returned.
    180       1.1  gdamore  */
    181       1.1  gdamore int
    182       1.1  gdamore spi_configure(struct spi_handle *sh, int mode, int speed)
    183       1.1  gdamore {
    184       1.1  gdamore 	int			s, rv;
    185       1.1  gdamore 	struct spi_softc	*sc = sh->sh_sc;
    186       1.1  gdamore 	struct spi_controller	*tag = sh->sh_controller;
    187       1.1  gdamore 
    188       1.1  gdamore 	/* ensure that request is compatible with other devices on the bus */
    189       1.1  gdamore 	if ((sc->sc_mode >= 0) && (sc->sc_mode != mode))
    190       1.1  gdamore 		return EINVAL;
    191       1.1  gdamore 
    192  1.3.22.2    rmind 	s = splbio();
    193       1.1  gdamore 	/* pick lowest configured speed */
    194       1.1  gdamore 	if (speed == 0)
    195       1.1  gdamore 		speed = sc->sc_speed;
    196       1.1  gdamore 	if (sc->sc_speed)
    197       1.1  gdamore 		speed = min(sc->sc_speed, speed);
    198       1.1  gdamore 
    199       1.1  gdamore 	rv = (*tag->sct_configure)(tag->sct_cookie, sh->sh_slave,
    200       1.1  gdamore 	    mode, speed);
    201       1.1  gdamore 
    202       1.1  gdamore 	if (rv == 0) {
    203       1.1  gdamore 		sc->sc_mode = mode;
    204       1.1  gdamore 		sc->sc_speed = speed;
    205       1.1  gdamore 	}
    206       1.1  gdamore 	splx(s);
    207       1.1  gdamore 	return rv;
    208       1.1  gdamore }
    209       1.1  gdamore 
    210       1.1  gdamore void
    211       1.1  gdamore spi_transfer_init(struct spi_transfer *st)
    212       1.1  gdamore {
    213       1.1  gdamore 
    214  1.3.22.2    rmind 	mutex_init(&st->st_lock, MUTEX_DEFAULT, IPL_BIO);
    215  1.3.22.2    rmind 	cv_init(&st->st_cv, "spicv");
    216  1.3.22.2    rmind 
    217       1.1  gdamore 	st->st_flags = 0;
    218       1.1  gdamore 	st->st_errno = 0;
    219       1.1  gdamore 	st->st_done = NULL;
    220       1.1  gdamore 	st->st_chunks = NULL;
    221       1.1  gdamore 	st->st_private = NULL;
    222       1.1  gdamore 	st->st_slave = -1;
    223       1.1  gdamore }
    224       1.1  gdamore 
    225       1.1  gdamore void
    226       1.1  gdamore spi_chunk_init(struct spi_chunk *chunk, int cnt, const uint8_t *wptr,
    227       1.1  gdamore     uint8_t *rptr)
    228       1.1  gdamore {
    229       1.1  gdamore 
    230       1.1  gdamore 	chunk->chunk_write = chunk->chunk_wptr = wptr;
    231       1.1  gdamore 	chunk->chunk_read = chunk->chunk_read = rptr;
    232       1.1  gdamore 	chunk->chunk_rresid = chunk->chunk_wresid = chunk->chunk_count = cnt;
    233       1.1  gdamore 	chunk->chunk_next = NULL;
    234       1.1  gdamore }
    235       1.1  gdamore 
    236       1.1  gdamore void
    237       1.1  gdamore spi_transfer_add(struct spi_transfer *st, struct spi_chunk *chunk)
    238       1.1  gdamore {
    239       1.1  gdamore 	struct spi_chunk **cpp;
    240       1.1  gdamore 
    241       1.1  gdamore 	/* this is an O(n) insert -- perhaps we should use a simpleq? */
    242       1.1  gdamore 	for (cpp = &st->st_chunks; *cpp; cpp = &(*cpp)->chunk_next);
    243       1.1  gdamore 	*cpp = chunk;
    244       1.1  gdamore }
    245       1.1  gdamore 
    246       1.1  gdamore int
    247       1.1  gdamore spi_transfer(struct spi_handle *sh, struct spi_transfer *st)
    248       1.1  gdamore {
    249       1.1  gdamore 	struct spi_controller	*tag = sh->sh_controller;
    250       1.1  gdamore 	struct spi_chunk	*chunk;
    251       1.1  gdamore 
    252       1.1  gdamore 	/*
    253       1.1  gdamore 	 * Initialize "resid" counters and pointers, so that callers
    254       1.1  gdamore 	 * and bus drivers don't have to.
    255       1.1  gdamore 	 */
    256       1.1  gdamore 	for (chunk = st->st_chunks; chunk; chunk = chunk->chunk_next) {
    257       1.1  gdamore 		chunk->chunk_wresid = chunk->chunk_rresid = chunk->chunk_count;
    258       1.1  gdamore 		chunk->chunk_wptr = chunk->chunk_write;
    259       1.1  gdamore 		chunk->chunk_rptr = chunk->chunk_read;
    260       1.1  gdamore 	}
    261       1.1  gdamore 
    262       1.1  gdamore 	/*
    263       1.1  gdamore 	 * Match slave to handle's slave.
    264       1.1  gdamore 	 */
    265       1.1  gdamore 	st->st_slave = sh->sh_slave;
    266       1.1  gdamore 
    267       1.1  gdamore 	return (*tag->sct_transfer)(tag->sct_cookie, st);
    268       1.1  gdamore }
    269       1.1  gdamore 
    270       1.1  gdamore void
    271       1.1  gdamore spi_wait(struct spi_transfer *st)
    272       1.1  gdamore {
    273       1.1  gdamore 
    274  1.3.22.2    rmind 	mutex_enter(&st->st_lock);
    275  1.3.22.1    rmind 	while (!(st->st_flags & SPI_F_DONE)) {
    276  1.3.22.2    rmind 		cv_wait(&st->st_cv, &st->st_lock);
    277       1.1  gdamore 	}
    278  1.3.22.2    rmind 	mutex_exit(&st->st_lock);
    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 
    285  1.3.22.2    rmind 	mutex_enter(&st->st_lock);
    286       1.1  gdamore 	if ((st->st_errno = err) != 0) {
    287       1.1  gdamore 		st->st_flags |= SPI_F_ERROR;
    288       1.1  gdamore 	}
    289       1.1  gdamore 	st->st_flags |= SPI_F_DONE;
    290       1.1  gdamore 	if (st->st_done != NULL) {
    291       1.1  gdamore 		(*st->st_done)(st);
    292       1.1  gdamore 	} else {
    293  1.3.22.2    rmind 		cv_broadcast(&st->st_cv);
    294       1.1  gdamore 	}
    295  1.3.22.2    rmind 	mutex_exit(&st->st_lock);
    296       1.1  gdamore }
    297       1.1  gdamore 
    298       1.1  gdamore /*
    299       1.1  gdamore  * Some convenience routines.  These routines block until the work
    300       1.1  gdamore  * is done.
    301       1.1  gdamore  *
    302       1.1  gdamore  * spi_recv - receives data from the bus
    303       1.1  gdamore  *
    304       1.1  gdamore  * spi_send - sends data to the bus
    305       1.1  gdamore  *
    306       1.1  gdamore  * spi_send_recv - sends data to the bus, and then receives.  Note that this is
    307       1.1  gdamore  * done synchronously, i.e. send a command and get the response.  This is
    308       1.1  gdamore  * not full duplex.  If you wnat full duplex, you can't use these convenience
    309       1.1  gdamore  * wrappers.
    310       1.1  gdamore  */
    311       1.1  gdamore int
    312       1.1  gdamore spi_recv(struct spi_handle *sh, int cnt, uint8_t *data)
    313       1.1  gdamore {
    314       1.1  gdamore 	struct spi_transfer	trans;
    315       1.1  gdamore 	struct spi_chunk	chunk;
    316       1.1  gdamore 
    317       1.1  gdamore 	spi_transfer_init(&trans);
    318       1.1  gdamore 	spi_chunk_init(&chunk, cnt, NULL, data);
    319       1.1  gdamore 	spi_transfer_add(&trans, &chunk);
    320       1.1  gdamore 
    321       1.1  gdamore 	/* enqueue it and wait for it to complete */
    322       1.1  gdamore 	spi_transfer(sh, &trans);
    323       1.1  gdamore 	spi_wait(&trans);
    324       1.1  gdamore 
    325       1.1  gdamore 	if (trans.st_flags & SPI_F_ERROR)
    326       1.1  gdamore 		return trans.st_errno;
    327       1.1  gdamore 
    328       1.1  gdamore 	return 0;
    329       1.1  gdamore }
    330       1.1  gdamore 
    331       1.1  gdamore int
    332       1.1  gdamore spi_send(struct spi_handle *sh, int cnt, const uint8_t *data)
    333       1.1  gdamore {
    334       1.1  gdamore 	struct spi_transfer	trans;
    335       1.1  gdamore 	struct spi_chunk	chunk;
    336       1.1  gdamore 
    337       1.1  gdamore 	spi_transfer_init(&trans);
    338       1.1  gdamore 	spi_chunk_init(&chunk, cnt, data, NULL);
    339       1.1  gdamore 	spi_transfer_add(&trans, &chunk);
    340       1.1  gdamore 
    341       1.1  gdamore 	/* enqueue it and wait for it to complete */
    342       1.1  gdamore 	spi_transfer(sh, &trans);
    343       1.1  gdamore 	spi_wait(&trans);
    344       1.1  gdamore 
    345       1.1  gdamore 	if (trans.st_flags & SPI_F_ERROR)
    346       1.1  gdamore 		return trans.st_errno;
    347       1.1  gdamore 
    348       1.1  gdamore 	return 0;
    349       1.1  gdamore }
    350       1.1  gdamore 
    351       1.1  gdamore int
    352       1.1  gdamore spi_send_recv(struct spi_handle *sh, int scnt, const uint8_t *snd,
    353       1.1  gdamore     int rcnt, uint8_t *rcv)
    354       1.1  gdamore {
    355       1.1  gdamore 	struct spi_transfer	trans;
    356       1.1  gdamore 	struct spi_chunk	chunk1, chunk2;
    357       1.1  gdamore 
    358       1.1  gdamore 	spi_transfer_init(&trans);
    359       1.1  gdamore 	spi_chunk_init(&chunk1, scnt, snd, NULL);
    360       1.1  gdamore 	spi_chunk_init(&chunk2, rcnt, NULL, rcv);
    361       1.1  gdamore 	spi_transfer_add(&trans, &chunk1);
    362       1.1  gdamore 	spi_transfer_add(&trans, &chunk2);
    363       1.1  gdamore 
    364       1.1  gdamore 	/* enqueue it and wait for it to complete */
    365       1.1  gdamore 	spi_transfer(sh, &trans);
    366       1.1  gdamore 	spi_wait(&trans);
    367       1.1  gdamore 
    368       1.1  gdamore 	if (trans.st_flags & SPI_F_ERROR)
    369       1.1  gdamore 		return trans.st_errno;
    370       1.1  gdamore 
    371       1.1  gdamore 	return 0;
    372       1.1  gdamore }
    373