diff options
Diffstat (limited to 'board/sc520_cdp/sc520_cdp.c')
| -rw-r--r-- | board/sc520_cdp/sc520_cdp.c | 286 | 
1 files changed, 141 insertions, 145 deletions
| diff --git a/board/sc520_cdp/sc520_cdp.c b/board/sc520_cdp/sc520_cdp.c index 50a49e601..0fc836c62 100644 --- a/board/sc520_cdp/sc520_cdp.c +++ b/board/sc520_cdp/sc520_cdp.c @@ -1,5 +1,5 @@  /* - *  + *   * (C) Copyright 2002   * Daniel Engström, Omicron Ceti AB <daniel@omicron.se>.   * @@ -40,11 +40,11 @@  /* ------------------------------------------------------------------------- */ -	 -/*  + +/*   * Theory:   * We first set up all IRQs to be non-pci, edge triggered, - * when we later enumerate the pci bus and pci_sc520_fixup_irq() gets  + * when we later enumerate the pci bus and pci_sc520_fixup_irq() gets   * called we reallocate irqs to the pci bus with sc520_pci_set_irq()   * as needed. Whe choose the irqs to gram from a configurable list   * inside pci_sc520_fixup_irq() (If this list contains stupid irq's @@ -54,48 +54,48 @@  static void irq_init(void)  {  	/* disable global interrupt mode */ -	write_mmcr_byte(SC520_PICICR, 0x40);  -	 +	write_mmcr_byte(SC520_PICICR, 0x40); +  	/* set all irqs to edge */  	write_mmcr_byte(SC520_MPICMODE, 0x00);  	write_mmcr_byte(SC520_SL1PICMODE, 0x00);  	write_mmcr_byte(SC520_SL2PICMODE, 0x00); -	 -	/* active low polarity on PIC interrupt pins,  + +	/* active low polarity on PIC interrupt pins,  	 *  active high polarity on all other irq pins */  	write_mmcr_word(SC520_INTPINPOL, 0x0000);  	/* set irq number mapping */ -	write_mmcr_byte(SC520_GPTMR0MAP, SC520_IRQ_DISABLED);   /* disable GP timer 0 INT */        +	write_mmcr_byte(SC520_GPTMR0MAP, SC520_IRQ_DISABLED);   /* disable GP timer 0 INT */  	write_mmcr_byte(SC520_GPTMR1MAP, SC520_IRQ_DISABLED);   /* disable GP timer 1 INT */  	write_mmcr_byte(SC520_GPTMR2MAP, SC520_IRQ_DISABLED);   /* disable GP timer 2 INT */ -	write_mmcr_byte(SC520_PIT0MAP, SC520_IRQ0);             /* Set PIT timer 0 INT to IRQ0 */  +	write_mmcr_byte(SC520_PIT0MAP, SC520_IRQ0);             /* Set PIT timer 0 INT to IRQ0 */  	write_mmcr_byte(SC520_PIT1MAP, SC520_IRQ_DISABLED);     /* disable PIT timer 1 INT */  	write_mmcr_byte(SC520_PIT2MAP, SC520_IRQ_DISABLED);     /* disable PIT timer 2 INT */  	write_mmcr_byte(SC520_PCIINTAMAP, SC520_IRQ_DISABLED);  /* disable PCI INT A */  	write_mmcr_byte(SC520_PCIINTBMAP, SC520_IRQ_DISABLED);  /* disable PCI INT B */  	write_mmcr_byte(SC520_PCIINTCMAP, SC520_IRQ_DISABLED);  /* disable PCI INT C */  	write_mmcr_byte(SC520_PCIINTDMAP, SC520_IRQ_DISABLED);  /* disable PCI INT D */ -	write_mmcr_byte(SC520_DMABCINTMAP, SC520_IRQ_DISABLED); /* disable DMA INT */  +	write_mmcr_byte(SC520_DMABCINTMAP, SC520_IRQ_DISABLED); /* disable DMA INT */  	write_mmcr_byte(SC520_SSIMAP, SC520_IRQ_DISABLED);      /* disable Synchronius serial INT */  	write_mmcr_byte(SC520_WDTMAP, SC520_IRQ_DISABLED);      /* disable Watchdog INT */  	write_mmcr_byte(SC520_RTCMAP, SC520_IRQ8);              /* Set RTC int to 8 */  	write_mmcr_byte(SC520_WPVMAP, SC520_IRQ_DISABLED);      /* disable write protect INT */  	write_mmcr_byte(SC520_ICEMAP, SC520_IRQ1);              /* Set ICE Debug Serielport INT to IRQ1 */  	write_mmcr_byte(SC520_FERRMAP,SC520_IRQ13);             /* Set FP error INT to IRQ13 */ -	 +  	if (CFG_USE_SIO_UART) {  		write_mmcr_byte(SC520_UART1MAP, SC520_IRQ_DISABLED); /* disable internal UART1 INT */  		write_mmcr_byte(SC520_UART2MAP, SC520_IRQ_DISABLED); /* disable internal UART2 INT */ -		write_mmcr_byte(SC520_GP3IMAP, SC520_IRQ3);          /* Set GPIRQ3 (ISA IRQ3) to IRQ3 */  +		write_mmcr_byte(SC520_GP3IMAP, SC520_IRQ3);          /* Set GPIRQ3 (ISA IRQ3) to IRQ3 */  		write_mmcr_byte(SC520_GP4IMAP, SC520_IRQ4);          /* Set GPIRQ4 (ISA IRQ4) to IRQ4 */  	} else {  		write_mmcr_byte(SC520_UART1MAP, SC520_IRQ4);         /* Set internal UART2 INT to IRQ4 */  		write_mmcr_byte(SC520_UART2MAP, SC520_IRQ3);         /* Set internal UART2 INT to IRQ3 */ -		write_mmcr_byte(SC520_GP3IMAP, SC520_IRQ_DISABLED);  /* disable GPIRQ3 (ISA IRQ3) */  +		write_mmcr_byte(SC520_GP3IMAP, SC520_IRQ_DISABLED);  /* disable GPIRQ3 (ISA IRQ3) */  		write_mmcr_byte(SC520_GP4IMAP, SC520_IRQ_DISABLED);  /* disable GPIRQ4 (ISA IRQ4) */  	} -	 +  	write_mmcr_byte(SC520_GP1IMAP, SC520_IRQ1);             /* Set GPIRQ1 (SIO IRQ1) to IRQ1 */  	write_mmcr_byte(SC520_GP5IMAP, SC520_IRQ5);             /* Set GPIRQ5 (ISA IRQ5) to IRQ5 */  	write_mmcr_byte(SC520_GP6IMAP, SC520_IRQ6);             /* Set GPIRQ6 (ISA IRQ6) to IRQ6 */ @@ -104,14 +104,14 @@ static void irq_init(void)  	write_mmcr_byte(SC520_GP9IMAP, SC520_IRQ9);             /* Set GPIRQ9 (ISA IRQ2) to IRQ9 */  	write_mmcr_byte(SC520_GP0IMAP, SC520_IRQ11);            /* Set GPIRQ0 (ISA IRQ11) to IRQ10 */  	write_mmcr_byte(SC520_GP2IMAP, SC520_IRQ12);            /* Set GPIRQ2 (ISA IRQ12) to IRQ12 */ -	write_mmcr_byte(SC520_GP10IMAP,SC520_IRQ14);            /* Set GPIRQ10 (ISA IRQ14) to IRQ14 */           -	 +	write_mmcr_byte(SC520_GP10IMAP,SC520_IRQ14);            /* Set GPIRQ10 (ISA IRQ14) to IRQ14 */ +  	write_mmcr_word(SC520_PCIHOSTMAP, 0x11f);                /* Map PCI hostbridge INT to NMI */  	write_mmcr_word(SC520_ECCMAP, 0x100);                    /* Map SDRAM ECC failure INT to NMI */ -  +  } -	 +  /* PCI stuff */  static void pci_sc520_cdp_fixup_irq(struct pci_controller *hose, pci_dev_t dev)  { @@ -125,64 +125,63 @@ static void pci_sc520_cdp_fixup_irq(struct pci_controller *hose, pci_dev_t dev)  		CFG_FORTH_PCI_IRQ  	};  	static int next_irq_index=0; -	 -	char tmp_pin;	 + +	char tmp_pin;  	int pin; -	 +  	pci_hose_read_config_byte(hose, dev, PCI_INTERRUPT_PIN, &tmp_pin);  	pin = tmp_pin; -	 +  	pin-=1; /* pci config space use 1-based numbering */  	if (-1 == pin) {  		return; /* device use no irq */  	} -	 -	 -        + +  	/* map device number +  pin to a pin on the sc520 */  	switch (PCI_DEV(dev)) {  	case 20:  		pin+=SC520_PCI_INTA;  		break; -		 +  	case 19:  		pin+=SC520_PCI_INTB;  		break; -		 +  	case 18:  		pin+=SC520_PCI_INTC;  		break; -		 +  	case 17:  		pin+=SC520_PCI_INTD;  		break; -		 -	default:  + +	default:  		return;  	} -	 +  	pin&=3; /* wrap around */ -	 +  	if (sc520_pci_ints[pin] == -1) { -		/* re-route one interrupt for us */		 +		/* re-route one interrupt for us */  		if (next_irq_index > 3) {  			return;  		} -		if (pci_sc520_set_irq(pin, irq_list[next_irq_index])) {  +		if (pci_sc520_set_irq(pin, irq_list[next_irq_index])) {  			return;  		}  		next_irq_index++;  	} -	 +  	if (-1 != sc520_pci_ints[pin]) { -		pci_hose_write_config_byte(hose, dev, PCI_INTERRUPT_LINE,  +		pci_hose_write_config_byte(hose, dev, PCI_INTERRUPT_LINE,  					   sc520_pci_ints[pin]);  	} -	PRINTF("fixup_irq: device %d pin %c irq %d\n",  +	PRINTF("fixup_irq: device %d pin %c irq %d\n",  	       PCI_DEV(dev), 'A' + pin, sc520_pci_ints[pin]);  } -  +  static struct pci_controller sc520_cdp_hose = {  	fixup_irq: pci_sc520_cdp_fixup_irq,  }; @@ -201,7 +200,7 @@ static void silence_uart(int port)  void setup_ali_sio(int uart_primary)  {  	ali512x_init(); -	 +  	ali512x_set_fdc(ALI_ENABLED, 0x3f2, 6, 0);  	ali512x_set_pp(ALI_ENABLED, 0x278, 7, 3);  	ali512x_set_uart(ALI_ENABLED, ALI_UART1, uart_primary?0x3f8:0x3e8, 4); @@ -209,21 +208,21 @@ void setup_ali_sio(int uart_primary)  	ali512x_set_rtc(ALI_DISABLED, 0, 0);  	ali512x_set_kbc(ALI_ENABLED, 1, 12);  	ali512x_set_cio(ALI_ENABLED); -	 +  	/* IrDa pins */  	ali512x_cio_function(12, 1, 0, 0);  	ali512x_cio_function(13, 1, 0, 0); -	 +  	/* SSI chip select pins */  	ali512x_cio_function(14, 0, 0, 0);  /* SSI_CS */ -	ali512x_cio_function(15, 0, 0, 0);  /* SSI_MV */  +	ali512x_cio_function(15, 0, 0, 0);  /* SSI_MV */  	ali512x_cio_function(16, 0, 0, 0);  /* SSI_SPI# */  	/* Board REV pins */  	ali512x_cio_function(20, 0, 0, 1);  	ali512x_cio_function(21, 0, 0, 1);  	ali512x_cio_function(22, 0, 0, 1); -	ali512x_cio_function(23, 0, 0, 1);       +	ali512x_cio_function(23, 0, 0, 1);  } @@ -232,54 +231,53 @@ static void bus_init(void)  {  	/* set up the GP IO pins */ -	write_mmcr_word(SC520_PIOPFS31_16, 0xf7ff); 	/* set the GPIO pin function 31-16 reg */		    +	write_mmcr_word(SC520_PIOPFS31_16, 0xf7ff); 	/* set the GPIO pin function 31-16 reg */  	write_mmcr_word(SC520_PIOPFS15_0, 0xffff);  	/* set the GPIO pin function 15-0 reg */ -	write_mmcr_byte(SC520_CSPFS, 0xf8);  		/* set the CS pin function  reg */	 +	write_mmcr_byte(SC520_CSPFS, 0xf8);  		/* set the CS pin function  reg */  	write_mmcr_byte(SC520_CLKSEL, 0x70); -	 -	write_mmcr_byte(SC520_GPCSRT, 1);   /* set the GP CS offset */    	 + +	write_mmcr_byte(SC520_GPCSRT, 1);   /* set the GP CS offset */  	write_mmcr_byte(SC520_GPCSPW, 3);   /* set the GP CS pulse width */  	write_mmcr_byte(SC520_GPCSOFF, 1);  /* set the GP CS offset */  	write_mmcr_byte(SC520_GPRDW, 3);    /* set the RD pulse width */  	write_mmcr_byte(SC520_GPRDOFF, 1);  /* set the GP RD offset */ -        write_mmcr_byte(SC520_GPWRW, 3);    /* set the GP WR pulse width */ +	write_mmcr_byte(SC520_GPWRW, 3);    /* set the GP WR pulse width */  	write_mmcr_byte(SC520_GPWROFF, 1);  /* set the GP WR offset */ -	write_mmcr_word(SC520_BOOTCSCTL, 0x1823);		/* set up timing of BOOTCS */  +	write_mmcr_word(SC520_BOOTCSCTL, 0x1823);		/* set up timing of BOOTCS */  	write_mmcr_word(SC520_ROMCS1CTL, 0x1823);		/* set up timing of ROMCS1 */ -	write_mmcr_word(SC520_ROMCS2CTL, 0x1823);		/* set up timing of ROMCS2 */  -	 +	write_mmcr_word(SC520_ROMCS2CTL, 0x1823);		/* set up timing of ROMCS2 */ +  	/* adjust the memory map:  	 * by default the first 256MB (0x00000000 - 0x0fffffff) is mapped to SDRAM  	 * and 256MB to 1G-128k  (0x1000000 - 0x37ffffff) is mapped to PCI mmio -	 * we need to map 1G-128k - 1G (0x38000000 - 0x3fffffff) to CS1 */  -	 -		 -	 +	 * we need to map 1G-128k - 1G (0x38000000 - 0x3fffffff) to CS1 */ + +  	/* SRAM = GPCS3 128k @ d0000-effff*/ -	write_mmcr_long(SC520_PAR2,  0x4e00400d);		 -	 +	write_mmcr_long(SC520_PAR2,  0x4e00400d); +  	/* IDE0 = GPCS6 1f0-1f7 */ -	write_mmcr_long(SC520_PAR3,  0x380801f0);		 +	write_mmcr_long(SC520_PAR3,  0x380801f0);  	/* IDE1 = GPCS7 3f6 */ -	write_mmcr_long(SC520_PAR4,  0x3c0003f6);		 +	write_mmcr_long(SC520_PAR4,  0x3c0003f6);  	/* bootcs */ -	write_mmcr_long(SC520_PAR12, 0x8bffe800);		 +	write_mmcr_long(SC520_PAR12, 0x8bffe800);  	/* romcs2 */ -	write_mmcr_long(SC520_PAR13, 0xcbfff000);		 +	write_mmcr_long(SC520_PAR13, 0xcbfff000);  	/* romcs1 */ -	write_mmcr_long(SC520_PAR14, 0xabfff800);		 +	write_mmcr_long(SC520_PAR14, 0xabfff800);  	/* 680 LEDS */ -	write_mmcr_long(SC520_PAR15, 0x30000640);		 -	 +	write_mmcr_long(SC520_PAR15, 0x30000640); +  	write_mmcr_byte(SC520_ADDDECCTL, 0); -	 -	asm ("wbinvd\n"); /* Flush cache, req. after setting the unchached attribute ona PAR */	 + +	asm ("wbinvd\n"); /* Flush cache, req. after setting the unchached attribute ona PAR */  	if (CFG_USE_SIO_UART) { -		write_mmcr_byte(SC520_ADDDECCTL, read_mmcr_byte(SC520_ADDDECCTL) | UART2_DIS|UART1_DIS);	 +		write_mmcr_byte(SC520_ADDDECCTL, read_mmcr_byte(SC520_ADDDECCTL) | UART2_DIS|UART1_DIS);  		setup_ali_sio(1);  	} else {  		write_mmcr_byte(SC520_ADDDECCTL, read_mmcr_byte(SC520_ADDDECCTL) & ~(UART2_DIS|UART1_DIS)); @@ -321,21 +319,21 @@ static void bus_init(void)   * PAR15  Port 0x680 LED display   */ -/*  +/*   * This function should map a chunk of size bytes   * of the system address space to the ISA bus - *  + *   * The function will return the memory address   * as seen by the host (which may very will be the   * same as the bus address)   */ -u32 isa_map_rom(u32 bus_addr, int size)  +u32 isa_map_rom(u32 bus_addr, int size)  {  	u32 par; -	 -	PRINTF("isa_map_rom asked to map %d bytes at %x\n",  + +	PRINTF("isa_map_rom asked to map %d bytes at %x\n",  	       size, bus_addr); -	 +  	par = size;  	if (par < 0x80000) {  		par = 0x80000; @@ -346,12 +344,12 @@ u32 isa_map_rom(u32 bus_addr, int size)  	par <<= 18;  	par |= (bus_addr>>12);  	par |= 0x50000000; -	 +  	PRINTF ("setting PAR11 to %x\n", par); -	 +  	/* Map rom 0x10000 with PAR1 */  	write_mmcr_long(SC520_PAR11,  par); -	 +  	return bus_addr;  } @@ -372,19 +370,19 @@ void isa_unmap_rom(u32 addr)  #ifdef CONFIG_PCI  #define PCI_ROM_TEMP_SPACE 0x10000 -/*  +/*   * This function should map a chunk of size bytes   * of the system address space to the PCI bus,   * suitable to map PCI ROMS (bus address < 16M)   * the function will return the host memory address   * which should be converted into a bus address - * before used to configure the PCI rom address  + * before used to configure the PCI rom address   * decoder   */ -u32 pci_get_rom_window(struct pci_controller *hose, int size)  +u32 pci_get_rom_window(struct pci_controller *hose, int size)  {  	u32 par; -	 +  	par = size;  	if (par < 0x80000) {  		par = 0x80000; @@ -395,12 +393,12 @@ u32 pci_get_rom_window(struct pci_controller *hose, int size)  	par <<= 14;  	par |= (PCI_ROM_TEMP_SPACE>>16);  	par |= 0x72000000; -	 +  	PRINTF ("setting PAR1 to %x\n", par); -	 +  	/* Map rom 0x10000 with PAR1 */  	write_mmcr_long(SC520_PAR1,  par); -	 +  	return PCI_ROM_TEMP_SPACE;  } @@ -417,61 +415,61 @@ void pci_remove_rom_window(struct pci_controller *hose, u32 addr)  		return;  	}  	PRINTF(" not ours\n"); -	 +  }  /*   * This function is called in order to provide acces to the - * legacy video I/O ports on the PCI bus.  - * After this function accesses to I/O ports 0x3b0-0x3bb and  + * legacy video I/O ports on the PCI bus. + * After this function accesses to I/O ports 0x3b0-0x3bb and   * 0x3c0-0x3df shuld result in transactions on the PCI bus. - *  + *   */  int pci_enable_legacy_video_ports(struct pci_controller *hose)  {  	/* Map video memory to 0xa0000*/  	write_mmcr_long(SC520_PAR0,  0x7200400a); -	 +  	/* forward all I/O accesses to PCI */ -	write_mmcr_byte(SC520_ADDDECCTL,  -			read_mmcr_byte(SC520_ADDDECCTL) | IO_HOLE_DEST_PCI);	 -	 -	 +	write_mmcr_byte(SC520_ADDDECCTL, +			read_mmcr_byte(SC520_ADDDECCTL) | IO_HOLE_DEST_PCI); + +  	/* so we map away all io ports to pci (only way to access pci io  	 * below 0x400. But then we have to map back the portions that we dont  	 * use so that the generate cycles on the GPIO bus where the sio and -	 * ISA slots are connected, this requre the use of several PAR registers  +	 * ISA slots are connected, this requre the use of several PAR registers  	 */ -	 +  	/* bring 0x100 - 0x1ef back to ISA using PAR5 */ -	write_mmcr_long(SC520_PAR5, 0x30ef0100);		 -	 +	write_mmcr_long(SC520_PAR5, 0x30ef0100); +  	/* IDE use 1f0-1f7 */ -	 +  	/* bring 0x1f8 - 0x2f7 back to ISA using PAR6 */ -	write_mmcr_long(SC520_PAR6, 0x30ff01f8);		 -	 +	write_mmcr_long(SC520_PAR6, 0x30ff01f8); +  	/* com2 use 2f8-2ff */ -	 +  	/* bring 0x300 - 0x3af back to ISA using PAR7 */ -	write_mmcr_long(SC520_PAR7, 0x30af0300);		 -	 +	write_mmcr_long(SC520_PAR7, 0x30af0300); +  	/* vga use 3b0-3bb */ -	 +  	/* bring 0x3bc - 0x3bf back to ISA using PAR8 */ -	write_mmcr_long(SC520_PAR8, 0x300303bc);		 -	 +	write_mmcr_long(SC520_PAR8, 0x300303bc); +  	/* vga use 3c0-3df */ -	 +  	/* bring 0x3e0 - 0x3f5 back to ISA using PAR9 */ -	write_mmcr_long(SC520_PAR9, 0x301503e0);		 -	 +	write_mmcr_long(SC520_PAR9, 0x301503e0); +  	/* ide use 3f6 */ -	 +  	/* bring 0x3f7  back to ISA using PAR10 */ -	write_mmcr_long(SC520_PAR10, 0x300003f7);		 -	 -	/* com1 use 3f8-3ff */		 +	write_mmcr_long(SC520_PAR10, 0x300003f7); + +	/* com1 use 3f8-3ff */  	return 0;  } @@ -484,20 +482,20 @@ int pci_enable_legacy_video_ports(struct pci_controller *hose)  int board_init(void)  {  	DECLARE_GLOBAL_DATA_PTR; -	 -	init_sc520();	 + +	init_sc520();  	bus_init();  	irq_init(); -		 +  	/* max drive current on SDRAM */  	write_mmcr_word(SC520_DSCTL, 0x0100); -		 +  	/* enter debug mode after next reset (only if jumper is also set) */  	write_mmcr_byte(SC520_RESCFG, 0x08);  	/* configure the software timer to 33.333MHz */  	write_mmcr_byte(SC520_SWTMRCFG, 0);  	gd->bus_clk = 33333000; -	 +  	return 0;  } @@ -518,98 +516,96 @@ int last_stage_init(void)  {  	int minor;  	int major; -	 +  	major = minor = 0;  	major |= ali512x_cio_in(23)?2:0;  	major |= ali512x_cio_in(22)?1:0;  	minor |= ali512x_cio_in(21)?2:0;  	minor |= ali512x_cio_in(20)?1:0; -	 +  	printf("AMD SC520 CDP revision %d.%d\n", major, minor); -	 +  	return 0;  } - -void ssi_chip_select(int dev)  +void ssi_chip_select(int dev)  { -	 +  	/* Spunk board: SPI EEPROM is active-low, MW EEPROM and AUX are active high */  	switch (dev) {  	case 1: /* SPI EEPROM */  		ali512x_cio_out(16, 0);  		break; -		 +  	case 2: /* MW EEPROM */  		ali512x_cio_out(15, 1);  		break; -		 -	case 3: /* AUX */				 + +	case 3: /* AUX */  		ali512x_cio_out(14, 1);  		break; -		 +  	case 0:  		ali512x_cio_out(16, 1);  		ali512x_cio_out(15, 0);  		ali512x_cio_out(14, 0);  		break; -		 +  	default:  		printf("Illegal SSI device requested: %d\n", dev);  	}  } -void spi_init_f(void)  +void spi_init_f(void)  {  #ifdef CONFIG_SC520_CDP_USE_SPI -	spi_eeprom_probe(1);  -#endif	 +	spi_eeprom_probe(1); +#endif  #ifdef CONFIG_SC520_CDP_USE_MW  	mw_eeprom_probe(2); -#endif		 +#endif  } -ssize_t spi_read(uchar *addr, int alen, uchar *buffer, int len)  +ssize_t spi_read(uchar *addr, int alen, uchar *buffer, int len)  {  	int offset;  	int i;  	ssize_t res; -	 +  	offset = 0;  	for (i=0;i<alen;i++) {  		offset <<= 8;  		offset |= addr[i];  	} -  +  #ifdef CONFIG_SC520_CDP_USE_SPI -	res = spi_eeprom_read(1, offset, buffer, len);  -#endif	 +	res = spi_eeprom_read(1, offset, buffer, len); +#endif  #ifdef CONFIG_SC520_CDP_USE_MW  	res = mw_eeprom_read(2, offset, buffer, len); -#endif	 +#endif  	return res;  } -ssize_t spi_write(uchar *addr, int alen, uchar *buffer, int len)  +ssize_t spi_write(uchar *addr, int alen, uchar *buffer, int len)  {  	int offset;  	int i;  	ssize_t res; -	 +  	offset = 0;  	for (i=0;i<alen;i++) {  		offset <<= 8;  		offset |= addr[i];  	} -		 +  #ifdef CONFIG_SC520_CDP_USE_SPI  	res = spi_eeprom_write(1, offset, buffer, len); -#endif	 +#endif  #ifdef CONFIG_SC520_CDP_USE_MW  	res = mw_eeprom_write(2, offset, buffer, len); -#endif	 +#endif  	return res;  } - |