Home | History | Annotate | Line # | Download | only in dev
zssp.c revision 1.1.20.1
      1  1.1.20.1  garbled /*	$NetBSD: zssp.c,v 1.1.20.1 2007/10/03 19:26:20 garbled Exp $	*/
      2       1.1     ober /*	$OpenBSD: zaurus_ssp.c,v 1.6 2005/04/08 21:58:49 uwe Exp $	*/
      3       1.1     ober 
      4       1.1     ober /*
      5       1.1     ober  * Copyright (c) 2005 Uwe Stuehler <uwe (at) bsdx.de>
      6       1.1     ober  *
      7       1.1     ober  * Permission to use, copy, modify, and distribute this software for any
      8       1.1     ober  * purpose with or without fee is hereby granted, provided that the above
      9       1.1     ober  * copyright notice and this permission notice appear in all copies.
     10       1.1     ober  *
     11       1.1     ober  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     12       1.1     ober  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     13       1.1     ober  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     14       1.1     ober  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     15       1.1     ober  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     16       1.1     ober  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     17       1.1     ober  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     18       1.1     ober  */
     19       1.1     ober 
     20       1.1     ober #include <sys/cdefs.h>
     21  1.1.20.1  garbled __KERNEL_RCSID(0, "$NetBSD: zssp.c,v 1.1.20.1 2007/10/03 19:26:20 garbled Exp $");
     22       1.1     ober 
     23       1.1     ober #include <sys/param.h>
     24       1.1     ober #include <sys/systm.h>
     25       1.1     ober #include <sys/device.h>
     26       1.1     ober 
     27       1.1     ober #include <machine/bus.h>
     28       1.1     ober 
     29       1.1     ober #include <arm/xscale/pxa2x0reg.h>
     30       1.1     ober #include <arm/xscale/pxa2x0var.h>
     31       1.1     ober #include <arm/xscale/pxa2x0_gpio.h>
     32       1.1     ober 
     33       1.1     ober #include <zaurus/dev/zsspvar.h>
     34       1.1     ober #include <zaurus/zaurus/zaurus_var.h>
     35       1.1     ober 
     36       1.1     ober #define GPIO_ADS7846_CS_C3000	14	/* SSP SFRM */
     37       1.1     ober #define GPIO_MAX1111_CS_C3000	20
     38       1.1     ober #define GPIO_TG_CS_C3000	53
     39       1.1     ober 
     40  1.1.20.1  garbled #define SSCR0_ADS7846_C3000	0x06ab /* 12bit/Microwire/div by 7 */
     41       1.1     ober #define SSCR0_MAX1111		0x0387
     42  1.1.20.1  garbled #define	SSCR0_LZ9JG18		0x01ab
     43       1.1     ober 
     44       1.1     ober struct zssp_softc {
     45       1.1     ober 	struct device sc_dev;
     46       1.1     ober 	bus_space_tag_t sc_iot;
     47       1.1     ober 	bus_space_handle_t sc_ioh;
     48       1.1     ober };
     49       1.1     ober 
     50       1.1     ober static int	zssp_match(struct device *, struct cfdata *, void *);
     51       1.1     ober static void	zssp_attach(struct device *, struct device *, void *);
     52       1.1     ober 
     53       1.1     ober CFATTACH_DECL(zssp, sizeof(struct zssp_softc),
     54       1.1     ober 	zssp_match, zssp_attach, NULL, NULL);
     55       1.1     ober 
     56  1.1.20.1  garbled static void	zssp_init(void);
     57  1.1.20.1  garbled static void	zssp_powerhook(int, void *);
     58  1.1.20.1  garbled 
     59  1.1.20.1  garbled static struct zssp_softc *zssp_sc;
     60  1.1.20.1  garbled 
     61       1.1     ober static int
     62       1.1     ober zssp_match(struct device *parent, struct cfdata *cf, void *aux)
     63       1.1     ober {
     64       1.1     ober 
     65  1.1.20.1  garbled 	if (zssp_sc != NULL)
     66  1.1.20.1  garbled 		return 0;
     67  1.1.20.1  garbled 
     68       1.1     ober 	return 1;
     69       1.1     ober }
     70       1.1     ober 
     71       1.1     ober static void
     72       1.1     ober zssp_attach(struct device *parent, struct device *self, void *aux)
     73       1.1     ober {
     74       1.1     ober 	struct zssp_softc *sc = (struct zssp_softc *)self;
     75       1.1     ober 
     76       1.1     ober 	sc->sc_iot = &pxa2x0_bs_tag;
     77       1.1     ober 	if (bus_space_map(sc->sc_iot, PXA2X0_SSP1_BASE, PXA2X0_SSP_SIZE,
     78       1.1     ober 	    0, &sc->sc_ioh)) {
     79       1.1     ober 		printf(": can't map bus space\n");
     80       1.1     ober 		return;
     81       1.1     ober 	}
     82       1.1     ober 
     83  1.1.20.1  garbled 	zssp_sc = sc;
     84  1.1.20.1  garbled 
     85       1.1     ober 	printf("\n");
     86       1.1     ober 
     87       1.1     ober 	if (powerhook_establish(sc->sc_dev.dv_xname, zssp_powerhook, sc)
     88       1.1     ober 	    == NULL) {
     89       1.1     ober 		printf("%s: can't establish power hook\n",
     90       1.1     ober 		    sc->sc_dev.dv_xname);
     91       1.1     ober 	}
     92       1.1     ober 
     93       1.1     ober 	zssp_init();
     94       1.1     ober }
     95       1.1     ober 
     96       1.1     ober /*
     97       1.1     ober  * Initialize the dedicated SSP unit and disable all chip selects.
     98       1.1     ober  * This function is called with interrupts disabled.
     99       1.1     ober  */
    100       1.1     ober static void
    101       1.1     ober zssp_init(void)
    102       1.1     ober {
    103       1.1     ober 	struct zssp_softc *sc;
    104       1.1     ober 
    105  1.1.20.1  garbled 	KASSERT(zssp_sc != NULL);
    106  1.1.20.1  garbled 	sc = zssp_sc;
    107       1.1     ober 
    108       1.1     ober 	pxa2x0_clkman_config(CKEN_SSP, 1);
    109       1.1     ober 
    110       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR0, SSCR0_LZ9JG18);
    111       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR1, 0);
    112       1.1     ober 
    113       1.1     ober 	pxa2x0_gpio_set_function(GPIO_ADS7846_CS_C3000, GPIO_OUT|GPIO_SET);
    114       1.1     ober 	pxa2x0_gpio_set_function(GPIO_MAX1111_CS_C3000, GPIO_OUT|GPIO_SET);
    115       1.1     ober 	pxa2x0_gpio_set_function(GPIO_TG_CS_C3000, GPIO_OUT|GPIO_SET);
    116       1.1     ober }
    117       1.1     ober 
    118       1.1     ober static void
    119       1.1     ober zssp_powerhook(int why, void *arg)
    120       1.1     ober {
    121       1.1     ober 	int s;
    122       1.1     ober 
    123       1.1     ober 	if (why == PWR_RESUME) {
    124       1.1     ober 		s = splhigh();
    125       1.1     ober 		zssp_init();
    126       1.1     ober 		splx(s);
    127       1.1     ober 	}
    128       1.1     ober }
    129       1.1     ober 
    130       1.1     ober /*
    131       1.1     ober  * Transmit a single data word to one of the ICs, keep the chip selected
    132       1.1     ober  * afterwards, and don't wait for data to be returned in SSDR.  Interrupts
    133       1.1     ober  * must be held off until zssp_ic_stop() gets called.
    134       1.1     ober  */
    135       1.1     ober void
    136       1.1     ober zssp_ic_start(int ic, uint32_t data)
    137       1.1     ober {
    138       1.1     ober 	struct zssp_softc *sc;
    139       1.1     ober 
    140  1.1.20.1  garbled 	KASSERT(zssp_sc != NULL);
    141  1.1.20.1  garbled 	sc = zssp_sc;
    142       1.1     ober 
    143       1.1     ober 	/* disable other ICs */
    144       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR0, 0);
    145       1.1     ober 	if (ic != ZSSP_IC_ADS7846)
    146       1.1     ober 		pxa2x0_gpio_set_bit(GPIO_ADS7846_CS_C3000);
    147       1.1     ober 	if (ic != ZSSP_IC_LZ9JG18)
    148       1.1     ober 		pxa2x0_gpio_set_bit(GPIO_TG_CS_C3000);
    149       1.1     ober 	if (ic != ZSSP_IC_MAX1111)
    150       1.1     ober 		pxa2x0_gpio_set_bit(GPIO_MAX1111_CS_C3000);
    151       1.1     ober 
    152       1.1     ober 	/* activate the chosen one */
    153       1.1     ober 	switch (ic) {
    154       1.1     ober 	case ZSSP_IC_ADS7846:
    155       1.1     ober 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR0,
    156       1.1     ober 		    SSCR0_ADS7846_C3000);
    157       1.1     ober 		pxa2x0_gpio_clear_bit(GPIO_ADS7846_CS_C3000);
    158       1.1     ober 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSDR, data);
    159       1.1     ober 		while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSSR)
    160       1.1     ober 		    & SSSR_TNF) != SSSR_TNF)
    161       1.1     ober 			continue;	/* poll */
    162       1.1     ober 		break;
    163       1.1     ober 	case ZSSP_IC_LZ9JG18:
    164       1.1     ober 		pxa2x0_gpio_clear_bit(GPIO_TG_CS_C3000);
    165       1.1     ober 		break;
    166       1.1     ober 	case ZSSP_IC_MAX1111:
    167       1.1     ober 		pxa2x0_gpio_clear_bit(GPIO_MAX1111_CS_C3000);
    168       1.1     ober 		break;
    169       1.1     ober 	}
    170       1.1     ober }
    171       1.1     ober 
    172       1.1     ober /*
    173       1.1     ober  * Read the last value from SSDR and deactivate all chip-selects.
    174       1.1     ober  */
    175       1.1     ober uint32_t
    176       1.1     ober zssp_ic_stop(int ic)
    177       1.1     ober {
    178       1.1     ober 	struct zssp_softc *sc;
    179       1.1     ober 	uint32_t rv;
    180       1.1     ober 
    181  1.1.20.1  garbled 	KASSERT(zssp_sc != NULL);
    182  1.1.20.1  garbled 	sc = zssp_sc;
    183       1.1     ober 
    184       1.1     ober 	switch (ic) {
    185       1.1     ober 	case ZSSP_IC_ADS7846:
    186       1.1     ober 		/* read result of last command */
    187       1.1     ober 		while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSSR)
    188       1.1     ober 		    & SSSR_RNE) != SSSR_RNE)
    189       1.1     ober 			continue;	/* poll */
    190       1.1     ober 		rv = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSDR);
    191       1.1     ober 		break;
    192       1.1     ober 	case ZSSP_IC_LZ9JG18:
    193       1.1     ober 	case ZSSP_IC_MAX1111:
    194       1.1     ober 		/* last value received is irrelevant or undefined */
    195       1.1     ober 	default:
    196       1.1     ober 		rv = 0;
    197       1.1     ober 		break;
    198       1.1     ober 	}
    199       1.1     ober 
    200       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_ADS7846_CS_C3000);
    201       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_TG_CS_C3000);
    202       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_MAX1111_CS_C3000);
    203       1.1     ober 
    204       1.1     ober 	return rv;
    205       1.1     ober }
    206       1.1     ober 
    207       1.1     ober /*
    208       1.1     ober  * Activate one of the chip-select lines, transmit one word value in
    209       1.1     ober  * each direction, and deactivate the chip-select again.
    210       1.1     ober  */
    211       1.1     ober uint32_t
    212       1.1     ober zssp_ic_send(int ic, uint32_t data)
    213       1.1     ober {
    214       1.1     ober 
    215       1.1     ober 	switch (ic) {
    216       1.1     ober 	case ZSSP_IC_MAX1111:
    217       1.1     ober 		return (zssp_read_max1111(data));
    218       1.1     ober 	case ZSSP_IC_ADS7846:
    219       1.1     ober 		return (zssp_read_ads7846(data));
    220       1.1     ober 	case ZSSP_IC_LZ9JG18:
    221       1.1     ober 		zssp_write_lz9jg18(data);
    222       1.1     ober 		return 0;
    223       1.1     ober 	default:
    224       1.1     ober 		printf("zssp_ic_send: invalid IC %d\n", ic);
    225       1.1     ober 		return 0;
    226       1.1     ober 	}
    227       1.1     ober }
    228       1.1     ober 
    229       1.1     ober int
    230       1.1     ober zssp_read_max1111(uint32_t cmd)
    231       1.1     ober {
    232       1.1     ober 	struct zssp_softc *sc;
    233  1.1.20.1  garbled 	int voltage[2];
    234  1.1.20.1  garbled 	int i;
    235  1.1.20.1  garbled 	int s;
    236       1.1     ober 
    237  1.1.20.1  garbled 	KASSERT(zssp_sc != NULL);
    238  1.1.20.1  garbled 	sc = zssp_sc;
    239       1.1     ober 
    240       1.1     ober 	s = splhigh();
    241       1.1     ober 
    242       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR0, 0);
    243       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR0, SSCR0_MAX1111);
    244       1.1     ober 
    245       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_TG_CS_C3000);
    246       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_ADS7846_CS_C3000);
    247       1.1     ober 	pxa2x0_gpio_clear_bit(GPIO_MAX1111_CS_C3000);
    248       1.1     ober 
    249       1.1     ober 	delay(1);
    250       1.1     ober 
    251       1.1     ober 	/* Send the command word and read a dummy word back. */
    252       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSDR, cmd);
    253       1.1     ober 	while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSSR)
    254       1.1     ober 	    & SSSR_TNF) != SSSR_TNF)
    255       1.1     ober 		continue;	/* poll */
    256       1.1     ober 	/* XXX is this delay necessary? */
    257       1.1     ober 	delay(1);
    258       1.1     ober 	while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSSR)
    259       1.1     ober 	    & SSSR_RNE) != SSSR_RNE)
    260       1.1     ober 		continue;	/* poll */
    261       1.1     ober 	(void) bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSDR);
    262       1.1     ober 
    263       1.1     ober 	for (i = 0; i < 2; i++) {
    264       1.1     ober 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSDR, 0);
    265       1.1     ober 		while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSSR)
    266       1.1     ober 		    & SSSR_TNF) != SSSR_TNF)
    267       1.1     ober 			continue;	/* poll */
    268       1.1     ober 		/* XXX again, is this delay necessary? */
    269       1.1     ober 		delay(1);
    270       1.1     ober 		while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSSR)
    271       1.1     ober 		    & SSSR_RNE) != SSSR_RNE)
    272       1.1     ober 			continue;	/* poll */
    273       1.1     ober 		voltage[i] = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
    274       1.1     ober 		    SSP_SSDR);
    275       1.1     ober 	}
    276       1.1     ober 
    277       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_TG_CS_C3000);
    278       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_ADS7846_CS_C3000);
    279       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_MAX1111_CS_C3000);
    280       1.1     ober 
    281       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR0, 0);
    282       1.1     ober 
    283       1.1     ober 	splx(s);
    284       1.1     ober 
    285       1.1     ober 	/* XXX no idea what this means, but it's what Linux would do. */
    286       1.1     ober 	if ((voltage[0] & 0xc0) != 0 || (voltage[1] & 0x3f) != 0) {
    287       1.1     ober 		voltage[0] = -1;
    288       1.1     ober 	} else {
    289       1.1     ober 		voltage[0] = ((voltage[0] << 2) & 0xfc) |
    290       1.1     ober 		    ((voltage[1] >> 6) & 0x03);
    291       1.1     ober 	}
    292       1.1     ober 
    293       1.1     ober 	return voltage[0];
    294       1.1     ober }
    295       1.1     ober 
    296       1.1     ober /* XXX - only does CS_ADS7846 */
    297       1.1     ober uint32_t
    298       1.1     ober zssp_read_ads7846(uint32_t cmd)
    299       1.1     ober {
    300       1.1     ober 	struct zssp_softc *sc;
    301       1.1     ober 	unsigned int cr0;
    302       1.1     ober 	uint32_t val;
    303  1.1.20.1  garbled 	int s;
    304       1.1     ober 
    305  1.1.20.1  garbled 	if (zssp_sc == NULL) {
    306       1.1     ober 		printf("zssp_read_ads7846: not configured\n");
    307       1.1     ober 		return 0;
    308       1.1     ober 	}
    309  1.1.20.1  garbled 	sc = zssp_sc;
    310       1.1     ober 
    311       1.1     ober 	s = splhigh();
    312  1.1.20.1  garbled 
    313  1.1.20.1  garbled 	if (ZAURUS_ISC3000) {
    314  1.1.20.1  garbled 		cr0 = SSCR0_ADS7846_C3000;
    315       1.1     ober 	} else {
    316  1.1.20.1  garbled 		cr0 = 0x00ab;
    317       1.1     ober 	}
    318       1.1     ober         bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR0, 0);
    319       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSCR0, cr0);
    320       1.1     ober 
    321       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_TG_CS_C3000);
    322       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_MAX1111_CS_C3000);
    323       1.1     ober 	pxa2x0_gpio_clear_bit(GPIO_ADS7846_CS_C3000);
    324       1.1     ober 
    325       1.1     ober 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SSP_SSDR, cmd);
    326       1.1     ober 
    327       1.1     ober 	while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSSR)
    328       1.1     ober 	    & SSSR_TNF) != SSSR_TNF)
    329       1.1     ober 		continue;	/* poll */
    330       1.1     ober 
    331       1.1     ober 	delay(1);
    332       1.1     ober 
    333       1.1     ober 	while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSSR)
    334       1.1     ober 	    & SSSR_RNE) != SSSR_RNE)
    335       1.1     ober 		continue;	/* poll */
    336       1.1     ober 
    337       1.1     ober 	val = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SSP_SSDR);
    338       1.1     ober 
    339  1.1.20.1  garbled 	pxa2x0_gpio_set_bit(GPIO_ADS7846_CS_C3000);
    340       1.1     ober 
    341       1.1     ober 	splx(s);
    342       1.1     ober 
    343       1.1     ober 	return val;
    344       1.1     ober }
    345       1.1     ober 
    346       1.1     ober void
    347       1.1     ober zssp_write_lz9jg18(uint32_t data)
    348       1.1     ober {
    349       1.1     ober 	int sclk_pin, sclk_fn;
    350       1.1     ober 	int sfrm_pin, sfrm_fn;
    351       1.1     ober 	int txd_pin, txd_fn;
    352       1.1     ober 	int rxd_pin, rxd_fn;
    353       1.1     ober 	int i;
    354  1.1.20.1  garbled 	int s;
    355       1.1     ober 
    356       1.1     ober 	/* XXX this creates a DAC command from a backlight duty value. */
    357       1.1     ober 	data = 0x40 | (data & 0x1f);
    358       1.1     ober 
    359       1.1     ober 	if (ZAURUS_ISC3000) {
    360       1.1     ober 		sclk_pin = 19;
    361       1.1     ober 		sfrm_pin = 14;
    362       1.1     ober 		txd_pin = 87;
    363       1.1     ober 		rxd_pin = 86;
    364       1.1     ober 	} else {
    365       1.1     ober 		sclk_pin = 23;
    366       1.1     ober 		sfrm_pin = 24;
    367       1.1     ober 		txd_pin = 25;
    368       1.1     ober 		rxd_pin = 26;
    369       1.1     ober 	}
    370       1.1     ober 
    371       1.1     ober 	s = splhigh();
    372       1.1     ober 
    373       1.1     ober 	sclk_fn = pxa2x0_gpio_get_function(sclk_pin);
    374       1.1     ober 	sfrm_fn = pxa2x0_gpio_get_function(sfrm_pin);
    375       1.1     ober 	txd_fn = pxa2x0_gpio_get_function(txd_pin);
    376       1.1     ober 	rxd_fn = pxa2x0_gpio_get_function(rxd_pin);
    377       1.1     ober 
    378       1.1     ober 	pxa2x0_gpio_set_function(sfrm_pin, GPIO_OUT | GPIO_SET);
    379       1.1     ober 	pxa2x0_gpio_set_function(sclk_pin, GPIO_OUT | GPIO_CLR);
    380       1.1     ober 	pxa2x0_gpio_set_function(txd_pin, GPIO_OUT | GPIO_CLR);
    381       1.1     ober 	pxa2x0_gpio_set_function(rxd_pin, GPIO_IN);
    382       1.1     ober 
    383       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_MAX1111_CS_C3000);
    384       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_ADS7846_CS_C3000);
    385       1.1     ober 	pxa2x0_gpio_clear_bit(GPIO_TG_CS_C3000);
    386       1.1     ober 
    387       1.1     ober 	delay(10);
    388       1.1     ober 
    389       1.1     ober 	for (i = 0; i < 8; i++) {
    390       1.1     ober 		if (data & 0x80)
    391       1.1     ober 			pxa2x0_gpio_set_bit(txd_pin);
    392       1.1     ober 		else
    393       1.1     ober 			pxa2x0_gpio_clear_bit(txd_pin);
    394       1.1     ober 		delay(10);
    395       1.1     ober 		pxa2x0_gpio_set_bit(sclk_pin);
    396       1.1     ober 		delay(10);
    397       1.1     ober 		pxa2x0_gpio_clear_bit(sclk_pin);
    398       1.1     ober 		delay(10);
    399       1.1     ober 		data <<= 1;
    400       1.1     ober 	}
    401       1.1     ober 
    402       1.1     ober 	pxa2x0_gpio_clear_bit(txd_pin);
    403       1.1     ober 	pxa2x0_gpio_set_bit(GPIO_TG_CS_C3000);
    404       1.1     ober 
    405       1.1     ober 	pxa2x0_gpio_set_function(sclk_pin, sclk_fn);
    406       1.1     ober 	pxa2x0_gpio_set_function(sfrm_pin, sfrm_fn);
    407       1.1     ober 	pxa2x0_gpio_set_function(txd_pin, txd_fn);
    408       1.1     ober 	pxa2x0_gpio_set_function(rxd_pin, rxd_fn);
    409       1.1     ober 
    410       1.1     ober 	splx(s);
    411       1.1     ober }
    412