board/sc520_cdp/sc520_cdp.c

   1 /*
   2  *
   3  * (C) Copyright 2002
   4  * Daniel Engström, Omicron Ceti AB <daniel@omicron.se>.
   5  *
   6  * See file CREDITS for list of people who contributed to this
   7  * project.
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License as
  11  * published by the Free Software Foundation; either version 2 of
  12  * the License, or (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22  * MA 02111-1307 USA
  23  */
  24
  25 #include <common.h>
  26 #include <pci.h>
  27 #include <asm/io.h>
  28 #include <asm/pci.h>
  29 #include <asm/ic/sc520.h>
  30 #include <asm/ic/ali512x.h>
  31 #include <spi.h>
  32
  33 DECLARE_GLOBAL_DATA_PTR;
  34
  35 #undef SC520_CDP_DEBUG
  36
  37 #ifdef  SC520_CDP_DEBUG
  38 #define PRINTF(fmt,args...)     printf (fmt ,##args)
  39 #else
  40 #define PRINTF(fmt,args...)
  41 #endif
  42
  43 /* ------------------------------------------------------------------------- */
  44
  45
  46 /*
  47  * Theory:
  48  * We first set up all IRQs to be non-pci, edge triggered,
  49  * when we later enumerate the pci bus and pci_sc520_fixup_irq() gets
  50  * called we reallocate irqs to the pci bus with sc520_pci_set_irq()
  51  * as needed. Whe choose the irqs to gram from a configurable list
  52  * inside pci_sc520_fixup_irq() (If this list contains stupid irq's
  53  * such as 0 thngas will not work)
  54  */
  55
  56 static void irq_init(void)
  57 {
  58         /* disable global interrupt mode */
  59         write_mmcr_byte(SC520_PICICR, 0x40);
  60
  61         /* set all irqs to edge */
  62         write_mmcr_byte(SC520_MPICMODE, 0x00);
  63         write_mmcr_byte(SC520_SL1PICMODE, 0x00);
  64         write_mmcr_byte(SC520_SL2PICMODE, 0x00);
  65
  66         /* active low polarity on PIC interrupt pins,
  67          *  active high polarity on all other irq pins */
  68         write_mmcr_word(SC520_INTPINPOL, 0x0000);
  69
  70         /* set irq number mapping */
  71         write_mmcr_byte(SC520_GPTMR0MAP, SC520_IRQ_DISABLED);   /* disable GP timer 0 INT */
  72         write_mmcr_byte(SC520_GPTMR1MAP, SC520_IRQ_DISABLED);   /* disable GP timer 1 INT */
  73         write_mmcr_byte(SC520_GPTMR2MAP, SC520_IRQ_DISABLED);   /* disable GP timer 2 INT */
  74         write_mmcr_byte(SC520_PIT0MAP, SC520_IRQ0);             /* Set PIT timer 0 INT to IRQ0 */
  75         write_mmcr_byte(SC520_PIT1MAP, SC520_IRQ_DISABLED);     /* disable PIT timer 1 INT */
  76         write_mmcr_byte(SC520_PIT2MAP, SC520_IRQ_DISABLED);     /* disable PIT timer 2 INT */
  77         write_mmcr_byte(SC520_PCIINTAMAP, SC520_IRQ_DISABLED);  /* disable PCI INT A */
  78         write_mmcr_byte(SC520_PCIINTBMAP, SC520_IRQ_DISABLED);  /* disable PCI INT B */
  79         write_mmcr_byte(SC520_PCIINTCMAP, SC520_IRQ_DISABLED);  /* disable PCI INT C */
  80         write_mmcr_byte(SC520_PCIINTDMAP, SC520_IRQ_DISABLED);  /* disable PCI INT D */
  81         write_mmcr_byte(SC520_DMABCINTMAP, SC520_IRQ_DISABLED); /* disable DMA INT */
  82         write_mmcr_byte(SC520_SSIMAP, SC520_IRQ_DISABLED);      /* disable Synchronius serial INT */
  83         write_mmcr_byte(SC520_WDTMAP, SC520_IRQ_DISABLED);      /* disable Watchdog INT */
  84         write_mmcr_byte(SC520_RTCMAP, SC520_IRQ8);              /* Set RTC int to 8 */
  85         write_mmcr_byte(SC520_WPVMAP, SC520_IRQ_DISABLED);      /* disable write protect INT */
  86         write_mmcr_byte(SC520_ICEMAP, SC520_IRQ1);              /* Set ICE Debug Serielport INT to IRQ1 */
  87         write_mmcr_byte(SC520_FERRMAP,SC520_IRQ13);             /* Set FP error INT to IRQ13 */
  88
  89         if (CFG_USE_SIO_UART) {
  90                 write_mmcr_byte(SC520_UART1MAP, SC520_IRQ_DISABLED); /* disable internal UART1 INT */
  91                 write_mmcr_byte(SC520_UART2MAP, SC520_IRQ_DISABLED); /* disable internal UART2 INT */
  92                 write_mmcr_byte(SC520_GP3IMAP, SC520_IRQ3);          /* Set GPIRQ3 (ISA IRQ3) to IRQ3 */
  93                 write_mmcr_byte(SC520_GP4IMAP, SC520_IRQ4);          /* Set GPIRQ4 (ISA IRQ4) to IRQ4 */
  94         } else {
  95                 write_mmcr_byte(SC520_UART1MAP, SC520_IRQ4);         /* Set internal UART2 INT to IRQ4 */
  96                 write_mmcr_byte(SC520_UART2MAP, SC520_IRQ3);         /* Set internal UART2 INT to IRQ3 */
  97                 write_mmcr_byte(SC520_GP3IMAP, SC520_IRQ_DISABLED);  /* disable GPIRQ3 (ISA IRQ3) */
  98                 write_mmcr_byte(SC520_GP4IMAP, SC520_IRQ_DISABLED);  /* disable GPIRQ4 (ISA IRQ4) */
  99         }
 100
 101         write_mmcr_byte(SC520_GP1IMAP, SC520_IRQ1);             /* Set GPIRQ1 (SIO IRQ1) to IRQ1 */
 102         write_mmcr_byte(SC520_GP5IMAP, SC520_IRQ5);             /* Set GPIRQ5 (ISA IRQ5) to IRQ5 */
 103         write_mmcr_byte(SC520_GP6IMAP, SC520_IRQ6);             /* Set GPIRQ6 (ISA IRQ6) to IRQ6 */
 104         write_mmcr_byte(SC520_GP7IMAP, SC520_IRQ7);             /* Set GPIRQ7 (ISA IRQ7) to IRQ7 */
 105         write_mmcr_byte(SC520_GP8IMAP, SC520_IRQ8);             /* Set GPIRQ8 (SIO IRQ8) to IRQ8 */
 106         write_mmcr_byte(SC520_GP9IMAP, SC520_IRQ9);             /* Set GPIRQ9 (ISA IRQ2) to IRQ9 */
 107         write_mmcr_byte(SC520_GP0IMAP, SC520_IRQ11);            /* Set GPIRQ0 (ISA IRQ11) to IRQ10 */
 108         write_mmcr_byte(SC520_GP2IMAP, SC520_IRQ12);            /* Set GPIRQ2 (ISA IRQ12) to IRQ12 */
 109         write_mmcr_byte(SC520_GP10IMAP,SC520_IRQ14);            /* Set GPIRQ10 (ISA IRQ14) to IRQ14 */
 110
 111         write_mmcr_word(SC520_PCIHOSTMAP, 0x11f);                /* Map PCI hostbridge INT to NMI */
 112         write_mmcr_word(SC520_ECCMAP, 0x100);                    /* Map SDRAM ECC failure INT to NMI */
 113
 114 }
 115
 116
 117 /* PCI stuff */
 118 static void pci_sc520_cdp_fixup_irq(struct pci_controller *hose, pci_dev_t dev)
 119 {
 120         /* a configurable lists of irqs to steal
 121          * when we need one (a board with more pci interrupt pins
 122          * would use a larger table */
 123         static int irq_list[] = {
 124                 CFG_FIRST_PCI_IRQ,
 125                 CFG_SECOND_PCI_IRQ,
 126                 CFG_THIRD_PCI_IRQ,
 127                 CFG_FORTH_PCI_IRQ
 128         };
 129         static int next_irq_index=0;
 130
 131         char tmp_pin;
 132         int pin;
 133
 134         pci_hose_read_config_byte(hose, dev, PCI_INTERRUPT_PIN, &tmp_pin);
 135         pin = tmp_pin;
 136
 137         pin-=1; /* pci config space use 1-based numbering */
 138         if (-1 == pin) {
 139                 return; /* device use no irq */
 140         }
 141
 142
 143         /* map device number +  pin to a pin on the sc520 */
 144         switch (PCI_DEV(dev)) {
 145         case 20:
 146                 pin+=SC520_PCI_INTA;
 147                 break;
 148
 149         case 19:
 150                 pin+=SC520_PCI_INTB;
 151                 break;
 152
 153         case 18:
 154                 pin+=SC520_PCI_INTC;
 155                 break;
 156
 157         case 17:
 158                 pin+=SC520_PCI_INTD;
 159                 break;
 160
 161         default:
 162                 return;
 163         }
 164
 165         pin&=3; /* wrap around */
 166
 167         if (sc520_pci_ints[pin] == -1) {
 168                 /* re-route one interrupt for us */
 169                 if (next_irq_index > 3) {
 170                         return;
 171                 }
 172                 if (pci_sc520_set_irq(pin, irq_list[next_irq_index])) {
 173                         return;
 174                 }
 175                 next_irq_index++;
 176         }
 177
 178
 179         if (-1 != sc520_pci_ints[pin]) {
 180                 pci_hose_write_config_byte(hose, dev, PCI_INTERRUPT_LINE,
 181                                            sc520_pci_ints[pin]);
 182         }
 183         PRINTF("fixup_irq: device %d pin %c irq %d\n",
 184                PCI_DEV(dev), 'A' + pin, sc520_pci_ints[pin]);
 185 }
 186
 187 static struct pci_controller sc520_cdp_hose = {
 188         fixup_irq: pci_sc520_cdp_fixup_irq,
 189 };
 190
 191 void pci_init_board(void)
 192 {
 193         pci_sc520_init(&sc520_cdp_hose);
 194 }
 195
 196
 197 static void silence_uart(int port)
 198 {
 199         outb(0, port+1);
 200 }
 201
 202 void setup_ali_sio(int uart_primary)
 203 {
 204         ali512x_init();
 205
 206         ali512x_set_fdc(ALI_ENABLED, 0x3f2, 6, 0);
 207         ali512x_set_pp(ALI_ENABLED, 0x278, 7, 3);
 208         ali512x_set_uart(ALI_ENABLED, ALI_UART1, uart_primary?0x3f8:0x3e8, 4);
 209         ali512x_set_uart(ALI_ENABLED, ALI_UART2, uart_primary?0x2f8:0x2e8, 3);
 210         ali512x_set_rtc(ALI_DISABLED, 0, 0);
 211         ali512x_set_kbc(ALI_ENABLED, 1, 12);
 212         ali512x_set_cio(ALI_ENABLED);
 213
 214         /* IrDa pins */
 215         ali512x_cio_function(12, 1, 0, 0);
 216         ali512x_cio_function(13, 1, 0, 0);
 217
 218         /* SSI chip select pins */
 219         ali512x_cio_function(14, 0, 0, 0);  /* SSI_CS */
 220         ali512x_cio_function(15, 0, 0, 0);  /* SSI_MV */
 221         ali512x_cio_function(16, 0, 0, 0);  /* SSI_SPI# */
 222
 223         /* Board REV pins */
 224         ali512x_cio_function(20, 0, 0, 1);
 225         ali512x_cio_function(21, 0, 0, 1);
 226         ali512x_cio_function(22, 0, 0, 1);
 227         ali512x_cio_function(23, 0, 0, 1);
 228 }
 229
 230
 231 /* set up the ISA bus timing and system address mappings */
 232 static void bus_init(void)
 233 {
 234
 235         /* set up the GP IO pins */
 236         write_mmcr_word(SC520_PIOPFS31_16, 0xf7ff);     /* set the GPIO pin function 31-16 reg */
 237         write_mmcr_word(SC520_PIOPFS15_0, 0xffff);      /* set the GPIO pin function 15-0 reg */
 238         write_mmcr_byte(SC520_CSPFS, 0xf8);             /* set the CS pin function  reg */
 239         write_mmcr_byte(SC520_CLKSEL, 0x70);
 240
 241
 242         write_mmcr_byte(SC520_GPCSRT, 1);   /* set the GP CS offset */
 243         write_mmcr_byte(SC520_GPCSPW, 3);   /* set the GP CS pulse width */
 244         write_mmcr_byte(SC520_GPCSOFF, 1);  /* set the GP CS offset */
 245         write_mmcr_byte(SC520_GPRDW, 3);    /* set the RD pulse width */
 246         write_mmcr_byte(SC520_GPRDOFF, 1);  /* set the GP RD offset */
 247         write_mmcr_byte(SC520_GPWRW, 3);    /* set the GP WR pulse width */
 248         write_mmcr_byte(SC520_GPWROFF, 1);  /* set the GP WR offset */
 249
 250         write_mmcr_word(SC520_BOOTCSCTL, 0x1823);               /* set up timing of BOOTCS */
 251         write_mmcr_word(SC520_ROMCS1CTL, 0x1823);               /* set up timing of ROMCS1 */
 252         write_mmcr_word(SC520_ROMCS2CTL, 0x1823);               /* set up timing of ROMCS2 */
 253
 254         /* adjust the memory map:
 255          * by default the first 256MB (0x00000000 - 0x0fffffff) is mapped to SDRAM
 256          * and 256MB to 1G-128k  (0x1000000 - 0x37ffffff) is mapped to PCI mmio
 257          * we need to map 1G-128k - 1G (0x38000000 - 0x3fffffff) to CS1 */
 258
 259
 260         /* SRAM = GPCS3 128k @ d0000-effff*/
 261         write_mmcr_long(SC520_PAR2,  0x4e00400d);
 262
 263         /* IDE0 = GPCS6 1f0-1f7 */
 264         write_mmcr_long(SC520_PAR3,  0x380801f0);
 265
 266         /* IDE1 = GPCS7 3f6 */
 267         write_mmcr_long(SC520_PAR4,  0x3c0003f6);
 268         /* bootcs */
 269         write_mmcr_long(SC520_PAR12, 0x8bffe800);
 270         /* romcs2 */
 271         write_mmcr_long(SC520_PAR13, 0xcbfff000);
 272         /* romcs1 */
 273         write_mmcr_long(SC520_PAR14, 0xabfff800);
 274         /* 680 LEDS */
 275         write_mmcr_long(SC520_PAR15, 0x30000640);
 276
 277         write_mmcr_byte(SC520_ADDDECCTL, 0);
 278
 279         asm ("wbinvd\n"); /* Flush cache, req. after setting the unchached attribute ona PAR */
 280
 281         if (CFG_USE_SIO_UART) {
 282                 write_mmcr_byte(SC520_ADDDECCTL, read_mmcr_byte(SC520_ADDDECCTL) | UART2_DIS|UART1_DIS);
 283                 setup_ali_sio(1);
 284         } else {
 285                 write_mmcr_byte(SC520_ADDDECCTL, read_mmcr_byte(SC520_ADDDECCTL) & ~(UART2_DIS|UART1_DIS));
 286                 setup_ali_sio(0);
 287                 silence_uart(0x3e8);
 288                 silence_uart(0x2e8);
 289         }
 290
 291 }
 292
 293 /* GPCS usage
 294  * GPCS0       PIO27 (NMI)
 295  * GPCS1       ROMCS1
 296  * GPCS2       ROMCS2
 297  * GPCS3       SRAMCS       PAR2
 298  * GPCS4       unused       PAR3
 299  * GPCS5       unused       PAR4
 300  * GPCS6       IDE
 301  * GPCS7       IDE
 302  */
 303
 304
 305 /* par usage:
 306  * PAR0   legacy_video
 307  * PAR1   PCI ROM mapping
 308  * PAR2   SRAM
 309  * PAR3   IDE
 310  * PAR4   IDE
 311  * PAR5   legacy_video
 312  * PAR6   legacy_video
 313  * PAR7   legacy_video
 314  * PAR8   legacy_video
 315  * PAR9   legacy_video
 316  * PAR10  legacy_video
 317  * PAR11  ISAROM
 318  * PAR12  BOOTCS
 319  * PAR13  ROMCS1
 320  * PAR14  ROMCS2
 321  * PAR15  Port 0x680 LED display
 322  */
 323
 324 /*
 325  * This function should map a chunk of size bytes
 326  * of the system address space to the ISA bus
 327  *
 328  * The function will return the memory address
 329  * as seen by the host (which may very will be the
 330  * same as the bus address)
 331  */
 332 u32 isa_map_rom(u32 bus_addr, int size)
 333 {
 334         u32 par;
 335
 336         PRINTF("isa_map_rom asked to map %d bytes at %x\n",
 337                size, bus_addr);
 338
 339         par = size;
 340         if (par < 0x80000) {
 341                 par = 0x80000;
 342         }
 343         par >>= 12;
 344         par--;
 345         par&=0x7f;
 346         par <<= 18;
 347         par |= (bus_addr>>12);
 348         par |= 0x50000000;
 349
 350         PRINTF ("setting PAR11 to %x\n", par);
 351
 352         /* Map rom 0x10000 with PAR1 */
 353         write_mmcr_long(SC520_PAR11,  par);
 354
 355         return bus_addr;
 356 }
 357
 358 /*
 359  * this function removed any mapping created
 360  * with pci_get_rom_window()
 361  */
 362 void isa_unmap_rom(u32 addr)
 363 {
 364         PRINTF("isa_unmap_rom asked to unmap %x", addr);
 365         if ((addr>>12) == (read_mmcr_long(SC520_PAR11)&0x3ffff)) {
 366                 write_mmcr_long(SC520_PAR11, 0);
 367                 PRINTF(" done\n");
 368                 return;
 369         }
 370         PRINTF(" not ours\n");
 371 }
 372
 373 #ifdef CONFIG_PCI
 374 #define PCI_ROM_TEMP_SPACE 0x10000
 375 /*
 376  * This function should map a chunk of size bytes
 377  * of the system address space to the PCI bus,
 378  * suitable to map PCI ROMS (bus address < 16M)
 379  * the function will return the host memory address
 380  * which should be converted into a bus address
 381  * before used to configure the PCI rom address
 382  * decoder
 383  */
 384 u32 pci_get_rom_window(struct pci_controller *hose, int size)
 385 {
 386         u32 par;
 387
 388         par = size;
 389         if (par < 0x80000) {
 390                 par = 0x80000;
 391         }
 392         par >>= 16;
 393         par--;
 394         par&=0x7ff;
 395         par <<= 14;
 396         par |= (PCI_ROM_TEMP_SPACE>>16);
 397         par |= 0x72000000;
 398
 399         PRINTF ("setting PAR1 to %x\n", par);
 400
 401         /* Map rom 0x10000 with PAR1 */
 402         write_mmcr_long(SC520_PAR1,  par);
 403
 404         return PCI_ROM_TEMP_SPACE;
 405 }
 406
 407 /*
 408  * this function removed any mapping created
 409  * with pci_get_rom_window()
 410  */
 411 void pci_remove_rom_window(struct pci_controller *hose, u32 addr)
 412 {
 413         PRINTF("pci_remove_rom_window: %x", addr);
 414         if (addr == PCI_ROM_TEMP_SPACE) {
 415                 write_mmcr_long(SC520_PAR1, 0);
 416                 PRINTF(" done\n");
 417                 return;
 418         }
 419         PRINTF(" not ours\n");
 420
 421 }
 422
 423 /*
 424  * This function is called in order to provide acces to the
 425  * legacy video I/O ports on the PCI bus.
 426  * After this function accesses to I/O ports 0x3b0-0x3bb and
 427  * 0x3c0-0x3df shuld result in transactions on the PCI bus.
 428  *
 429  */
 430 int pci_enable_legacy_video_ports(struct pci_controller *hose)
 431 {
 432         /* Map video memory to 0xa0000*/
 433         write_mmcr_long(SC520_PAR0,  0x7200400a);
 434
 435         /* forward all I/O accesses to PCI */
 436         write_mmcr_byte(SC520_ADDDECCTL,
 437                         read_mmcr_byte(SC520_ADDDECCTL) | IO_HOLE_DEST_PCI);
 438
 439
 440         /* so we map away all io ports to pci (only way to access pci io
 441          * below 0x400. But then we have to map back the portions that we dont
 442          * use so that the generate cycles on the GPIO bus where the sio and
 443          * ISA slots are connected, this requre the use of several PAR registers
 444          */
 445
 446         /* bring 0x100 - 0x1ef back to ISA using PAR5 */
 447         write_mmcr_long(SC520_PAR5, 0x30ef0100);
 448
 449         /* IDE use 1f0-1f7 */
 450
 451         /* bring 0x1f8 - 0x2f7 back to ISA using PAR6 */
 452         write_mmcr_long(SC520_PAR6, 0x30ff01f8);
 453
 454         /* com2 use 2f8-2ff */
 455
 456         /* bring 0x300 - 0x3af back to ISA using PAR7 */
 457         write_mmcr_long(SC520_PAR7, 0x30af0300);
 458
 459         /* vga use 3b0-3bb */
 460
 461         /* bring 0x3bc - 0x3bf back to ISA using PAR8 */
 462         write_mmcr_long(SC520_PAR8, 0x300303bc);
 463
 464         /* vga use 3c0-3df */
 465
 466         /* bring 0x3e0 - 0x3f5 back to ISA using PAR9 */
 467         write_mmcr_long(SC520_PAR9, 0x301503e0);
 468
 469         /* ide use 3f6 */
 470
 471         /* bring 0x3f7  back to ISA using PAR10 */
 472         write_mmcr_long(SC520_PAR10, 0x300003f7);
 473
 474         /* com1 use 3f8-3ff */
 475
 476         return 0;
 477 }
 478 #endif
 479
 480 /*
 481  * Miscelaneous platform dependent initialisations
 482  */
 483
 484 int board_init(void)
 485 {
 486         init_sc520();
 487         bus_init();
 488         irq_init();
 489
 490         /* max drive current on SDRAM */
 491         write_mmcr_word(SC520_DSCTL, 0x0100);
 492
 493         /* enter debug mode after next reset (only if jumper is also set) */
 494         write_mmcr_byte(SC520_RESCFG, 0x08);
 495         /* configure the software timer to 33.333MHz */
 496         write_mmcr_byte(SC520_SWTMRCFG, 0);
 497         gd->bus_clk = 33333000;
 498
 499         return 0;
 500 }
 501
 502 int dram_init(void)
 503 {
 504         init_sc520_dram();
 505         return 0;
 506 }
 507
 508 void show_boot_progress(int val)
 509 {
 510         outb(val&0xff, 0x80);
 511         outb((val&0xff00)>>8, 0x680);
 512 }
 513
 514
 515 int last_stage_init(void)
 516 {
 517         int minor;
 518         int major;
 519
 520         major = minor = 0;
 521         major |= ali512x_cio_in(23)?2:0;
 522         major |= ali512x_cio_in(22)?1:0;
 523         minor |= ali512x_cio_in(21)?2:0;
 524         minor |= ali512x_cio_in(20)?1:0;
 525
 526         printf("AMD SC520 CDP revision %d.%d\n", major, minor);
 527
 528         return 0;
 529 }
 530
 531
 532 void ssi_chip_select(int dev)
 533 {
 534
 535         /* Spunk board: SPI EEPROM is active-low, MW EEPROM and AUX are active high */
 536         switch (dev) {
 537         case 1: /* SPI EEPROM */
 538                 ali512x_cio_out(16, 0);
 539                 break;
 540
 541         case 2: /* MW EEPROM */
 542                 ali512x_cio_out(15, 1);
 543                 break;
 544
 545         case 3: /* AUX */
 546                 ali512x_cio_out(14, 1);
 547                 break;
 548
 549         case 0:
 550                 ali512x_cio_out(16, 1);
 551                 ali512x_cio_out(15, 0);
 552                 ali512x_cio_out(14, 0);
 553                 break;
 554
 555         default:
 556                 printf("Illegal SSI device requested: %d\n", dev);
 557         }
 558 }
 559
 560 void spi_eeprom_probe(int x)
 561 {
 562 }
 563
 564 int spi_eeprom_read(int x, int offset, char *buffer, int len)
 565 {
 566        return 0;
 567 }
 568
 569 int spi_eeprom_write(int x, int offset, char *buffer, int len)
 570 {
 571        return 0;
 572 }
 573
 574 void spi_init_f(void)
 575 {
 576 #ifdef CONFIG_SC520_CDP_USE_SPI
 577         spi_eeprom_probe(1);
 578 #endif
 579 #ifdef CONFIG_SC520_CDP_USE_MW
 580         mw_eeprom_probe(2);
 581 #endif
 582 }
 583
 584 ssize_t spi_read(uchar *addr, int alen, uchar *buffer, int len)
 585 {
 586         int offset;
 587         int i;
 588         ssize_t res;
 589
 590         offset = 0;
 591         for (i=0;i<alen;i++) {
 592                 offset <<= 8;
 593                 offset |= addr[i];
 594         }
 595
 596 #ifdef CONFIG_SC520_CDP_USE_SPI
 597         res = spi_eeprom_read(1, offset, buffer, len);
 598 #endif
 599 #ifdef CONFIG_SC520_CDP_USE_MW
 600         res = mw_eeprom_read(2, offset, buffer, len);
 601 #endif
 602 #if !defined(CONFIG_SC520_CDP_USE_SPI) && !defined(CONFIG_SC520_CDP_USE_MW)
 603         res = 0;
 604 #endif
 605         return res;
 606 }
 607
 608 ssize_t spi_write(uchar *addr, int alen, uchar *buffer, int len)
 609 {
 610         int offset;
 611         int i;
 612         ssize_t res;
 613
 614         offset = 0;
 615         for (i=0;i<alen;i++) {
 616                 offset <<= 8;
 617                 offset |= addr[i];
 618         }
 619
 620 #ifdef CONFIG_SC520_CDP_USE_SPI
 621         res = spi_eeprom_write(1, offset, buffer, len);
 622 #endif
 623 #ifdef CONFIG_SC520_CDP_USE_MW
 624         res = mw_eeprom_write(2, offset, buffer, len);
 625 #endif
 626 #if !defined(CONFIG_SC520_CDP_USE_SPI) && !defined(CONFIG_SC520_CDP_USE_MW)
 627         res = 0;
 628 #endif
 629         return res;
 630 }