Merge branch 'elf_reloc'
[platform/kernel/u-boot.git] / board / pcs440ep / pcs440ep.c
1 /*
2  * (C) Copyright 2006
3  * Stefan Roese, DENX Software Engineering, sr@denx.de.
4  *
5  * See file CREDITS for list of people who contributed to this
6  * project.
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of
11  * the License, or (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
21  * MA 02111-1307 USA
22  */
23
24 #include <common.h>
25 #include <asm/ppc4xx.h>
26 #include <malloc.h>
27 #include <command.h>
28 #include <crc.h>
29 #include <asm/processor.h>
30 #include <spd_sdram.h>
31 #include <status_led.h>
32 #include <sha1.h>
33 #include <asm/io.h>
34 #include <net.h>
35
36 DECLARE_GLOBAL_DATA_PTR;
37
38 extern flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS]; /* info for FLASH chips     */
39
40 unsigned char   sha1_checksum[SHA1_SUM_LEN];
41
42 /* swap 4 Bits (Bit0 = Bit3, Bit1 = Bit2, Bit2 = Bit1 and Bit3 = Bit0) */
43 unsigned char swapbits[16] = {0x0, 0x8, 0x4, 0xc, 0x2, 0xa, 0x6, 0xe,
44                               0x1, 0x9, 0x5, 0xd, 0x3, 0xb, 0x7, 0xf};
45
46 static void set_leds (int val)
47 {
48         out32(GPIO0_OR, (in32 (GPIO0_OR) & ~0x78000000) | (val << 27));
49 }
50
51 #define GET_LEDS ((in32 (GPIO0_OR) & 0x78000000) >> 27)
52
53 void __led_init (led_id_t mask, int state)
54 {
55         int     val = GET_LEDS;
56
57         if (state == STATUS_LED_ON)
58                 val |= mask;
59         else
60                 val &= ~mask;
61         set_leds (val);
62 }
63
64 void __led_set (led_id_t mask, int state)
65 {
66         int     val = GET_LEDS;
67
68         if (state == STATUS_LED_ON)
69                 val |= mask;
70         else if (state == STATUS_LED_OFF)
71                 val &= ~mask;
72         set_leds (val);
73 }
74
75 void __led_toggle (led_id_t mask)
76 {
77         int     val = GET_LEDS;
78
79         val ^= mask;
80         set_leds (val);
81 }
82
83 static void status_led_blink (void)
84 {
85         int     i;
86         int     val = GET_LEDS;
87
88         /* set all LED which are on, to state BLINKING */
89         for (i = 0; i < 4; i++) {
90                 if (val & 0x01) status_led_set (3 - i, STATUS_LED_BLINKING);
91                 else status_led_set (3 - i, STATUS_LED_OFF);
92                 val = val >> 1;
93         }
94 }
95
96 #if defined(CONFIG_SHOW_BOOT_PROGRESS)
97 void show_boot_progress (int val)
98 {
99         /* find all valid Codes for val in README */
100         if (val == -30) return;
101         if (val < 0) {
102                 /* smthing goes wrong */
103                 status_led_blink ();
104                 return;
105         }
106         switch (val) {
107                 case 1:
108                         /* validating Image */
109                         status_led_set (0, STATUS_LED_OFF);
110                         status_led_set (1, STATUS_LED_ON);
111                         status_led_set (2, STATUS_LED_ON);
112                         break;
113                 case 15:
114                         /* booting */
115                         status_led_set (0, STATUS_LED_ON);
116                         status_led_set (1, STATUS_LED_ON);
117                         status_led_set (2, STATUS_LED_ON);
118                         break;
119 #if 0
120                 case 64:
121                         /* starting Ethernet configuration */
122                         status_led_set (0, STATUS_LED_OFF);
123                         status_led_set (1, STATUS_LED_OFF);
124                         status_led_set (2, STATUS_LED_ON);
125                         break;
126 #endif
127                 case 80:
128                         /* loading Image */
129                         status_led_set (0, STATUS_LED_ON);
130                         status_led_set (1, STATUS_LED_OFF);
131                         status_led_set (2, STATUS_LED_ON);
132                         break;
133         }
134 }
135 #endif
136
137 int board_early_init_f(void)
138 {
139         register uint reg;
140
141         set_leds(0);                    /* display boot info counter */
142
143         /*--------------------------------------------------------------------
144          * Setup the external bus controller/chip selects
145          *-------------------------------------------------------------------*/
146         mtdcr(EBC0_CFGADDR, EBC0_CFG);
147         reg = mfdcr(EBC0_CFGDATA);
148         mtdcr(EBC0_CFGDATA, reg | 0x04000000);  /* Set ATC */
149
150         /*--------------------------------------------------------------------
151          * GPIO's are alreay setup in arch/powerpc/cpu/ppc4xx/cpu_init.c
152          * via define from board config file.
153          *-------------------------------------------------------------------*/
154
155         /*--------------------------------------------------------------------
156          * Setup the interrupt controller polarities, triggers, etc.
157          *-------------------------------------------------------------------*/
158         mtdcr(UIC0SR, 0xffffffff);      /* clear all */
159         mtdcr(UIC0ER, 0x00000000);      /* disable all */
160         mtdcr(UIC0CR, 0x00000001);      /* UIC1 crit is critical */
161         mtdcr(UIC0PR, 0xfffffe1f);      /* per ref-board manual */
162         mtdcr(UIC0TR, 0x01c00000);      /* per ref-board manual */
163         mtdcr(UIC0VR, 0x00000001);      /* int31 highest, base=0x000 */
164         mtdcr(UIC0SR, 0xffffffff);      /* clear all */
165
166         mtdcr(UIC1SR, 0xffffffff);      /* clear all */
167         mtdcr(UIC1ER, 0x00000000);      /* disable all */
168         mtdcr(UIC1CR, 0x00000000);      /* all non-critical */
169         mtdcr(UIC1PR, 0xffffe0ff);      /* per ref-board manual */
170         mtdcr(UIC1TR, 0x00ffc000);      /* per ref-board manual */
171         mtdcr(UIC1VR, 0x00000001);      /* int31 highest, base=0x000 */
172         mtdcr(UIC1SR, 0xffffffff);      /* clear all */
173
174         /*--------------------------------------------------------------------
175          * Setup other serial configuration
176          *-------------------------------------------------------------------*/
177         mfsdr(SDR0_PCI0, reg);
178         mtsdr(SDR0_PCI0, 0x80000000 | reg);     /* PCI arbiter enabled */
179         mtsdr(SDR0_PFC0, 0x00000000);   /* Pin function: enable GPIO49-63 */
180         mtsdr(SDR0_PFC1, 0x00048000);   /* Pin function: UART0 has 4 pins, select IRQ5 */
181
182         return 0;
183 }
184
185 #define EEPROM_LEN      256
186 static void load_ethaddr(void)
187 {
188         int     ok_ethaddr, ok_eth1addr;
189         int     ret;
190         uchar   buf[EEPROM_LEN];
191         char    *use_eeprom;
192         u16     checksumcrc16 = 0;
193
194         /* If the env is sane, then nothing for us to do */
195         ok_ethaddr = eth_getenv_enetaddr("ethaddr", buf);
196         ok_eth1addr = eth_getenv_enetaddr("eth1addr", buf);
197         if (ok_ethaddr && ok_eth1addr)
198                 return;
199
200         /* read the MACs from EEprom */
201         status_led_set (0, STATUS_LED_ON);
202         status_led_set (1, STATUS_LED_ON);
203         ret = eeprom_read (CONFIG_SYS_I2C_EEPROM_ADDR, 0, buf, EEPROM_LEN);
204         if (ret == 0) {
205                 checksumcrc16 = cyg_crc16 (buf, EEPROM_LEN - 2);
206                 /* check, if the EEprom is programmed:
207                  * - The Prefix(Byte 0,1,2) is equal to "ATR"
208                  * - The checksum, stored in the last 2 Bytes, is correct
209                  */
210                 if ((strncmp ((char *)buf,"ATR",3) != 0) ||
211                     ((checksumcrc16 >> 8) != buf[EEPROM_LEN - 2]) ||
212                     ((checksumcrc16 & 0xff) != buf[EEPROM_LEN - 1])) {
213                         /* EEprom is not programmed */
214                         printf("%s: EEPROM Checksum not OK\n", __FUNCTION__);
215                 } else {
216                         /* get the MACs */
217                         if (!ok_ethaddr)
218                                 eth_setenv_enetaddr("ethaddr", &buf[3]);
219                         if (!ok_eth1addr)
220                                 eth_setenv_enetaddr("eth1addr", &buf[9]);
221                         return;
222                 }
223         }
224
225         /* some error reading the EEprom */
226         if ((use_eeprom = getenv ("use_eeprom_ethaddr")) == NULL) {
227                 /* dont use bootcmd */
228                 setenv("bootdelay", "-1");
229                 return;
230         }
231         /* == default ? use standard */
232         if (strncmp (use_eeprom, "default", 7) == 0) {
233                 return;
234         }
235         /* Env doesnt exist -> hang */
236         status_led_blink ();
237         /* here we do this "handy" because we have no interrupts
238            at this time */
239         puts ("### EEPROM ERROR ### Please RESET the board ###\n");
240         for (;;) {
241                 __led_toggle (12);
242                 udelay (100000);
243         }
244         return;
245 }
246
247 #ifdef CONFIG_PREBOOT
248
249 static uchar kbd_magic_prefix[]         = "key_magic";
250 static uchar kbd_command_prefix[]       = "key_cmd";
251
252 struct kbd_data_t {
253         char s1;
254         char s2;
255 };
256
257 struct kbd_data_t* get_keys (struct kbd_data_t *kbd_data)
258 {
259         char *val;
260         unsigned long tmp;
261
262         /* use the DIPs for some bootoptions */
263         val = getenv (ENV_NAME_DIP);
264         tmp = simple_strtoul (val, NULL, 16);
265
266         kbd_data->s2 = (tmp & 0x0f);
267         kbd_data->s1 = (tmp & 0xf0) >> 4;
268         return kbd_data;
269 }
270
271 static int compare_magic (const struct kbd_data_t *kbd_data, char *str)
272 {
273         char s1 = str[0];
274
275         if (s1 >= '0' && s1 <= '9')
276                 s1 -= '0';
277         else if (s1 >= 'a' && s1 <= 'f')
278                 s1 = s1 - 'a' + 10;
279         else if (s1 >= 'A' && s1 <= 'F')
280                 s1 = s1 - 'A' + 10;
281         else
282                 return -1;
283
284         if (s1 != kbd_data->s1) return -1;
285
286         s1 = str[1];
287         if (s1 >= '0' && s1 <= '9')
288                 s1 -= '0';
289         else if (s1 >= 'a' && s1 <= 'f')
290                 s1 = s1 - 'a' + 10;
291         else if (s1 >= 'A' && s1 <= 'F')
292                 s1 = s1 - 'A' + 10;
293         else
294                 return -1;
295
296         if (s1 != kbd_data->s2) return -1;
297         return 0;
298 }
299
300 static char *key_match (const struct kbd_data_t *kbd_data)
301 {
302         char magic[sizeof (kbd_magic_prefix) + 1];
303         char *suffix;
304         char *kbd_magic_keys;
305
306         /*
307          * The following string defines the characters that can be appended
308          * to "key_magic" to form the names of environment variables that
309          * hold "magic" key codes, i. e. such key codes that can cause
310          * pre-boot actions. If the string is empty (""), then only
311          * "key_magic" is checked (old behaviour); the string "125" causes
312          * checks for "key_magic1", "key_magic2" and "key_magic5", etc.
313          */
314         if ((kbd_magic_keys = getenv ("magic_keys")) == NULL)
315                 kbd_magic_keys = "";
316
317         /* loop over all magic keys;
318          * use '\0' suffix in case of empty string
319          */
320         for (suffix = kbd_magic_keys; *suffix ||
321                      suffix == kbd_magic_keys; ++suffix) {
322                 sprintf (magic, "%s%c", kbd_magic_prefix, *suffix);
323                 if (compare_magic (kbd_data, getenv (magic)) == 0) {
324                         char cmd_name[sizeof (kbd_command_prefix) + 1];
325                         char *cmd;
326
327                         sprintf (cmd_name, "%s%c", kbd_command_prefix, *suffix);
328                         cmd = getenv (cmd_name);
329
330                         return (cmd);
331                 }
332         }
333         return (NULL);
334 }
335
336 #endif /* CONFIG_PREBOOT */
337
338 static int pcs440ep_readinputs (void)
339 {
340         int     i;
341         char    value[20];
342
343         /* read the inputs and set the Envvars */
344         /* Revision Level Bit 26 - 29 */
345         i = ((in32 (GPIO0_IR) & 0x0000003c) >> 2);
346         i = swapbits[i];
347         sprintf (value, "%02x", i);
348         setenv (ENV_NAME_REVLEV, value);
349         /* Solder Switch Bit 30 - 33 */
350         i = (in32 (GPIO0_IR) & 0x00000003) << 2;
351         i += (in32 (GPIO1_IR) & 0xc0000000) >> 30;
352         i = swapbits[i];
353         sprintf (value, "%02x", i);
354         setenv (ENV_NAME_SOLDER, value);
355         /* DIP Switch Bit 49 - 56 */
356         i = ((in32 (GPIO1_IR) & 0x00007f80) >> 7);
357         i = (swapbits[i & 0x0f] << 4) + swapbits[(i & 0xf0) >> 4];
358         sprintf (value, "%02x", i);
359         setenv (ENV_NAME_DIP, value);
360         return 0;
361 }
362
363
364 #if defined(CONFIG_SHA1_CHECK_UB_IMG)
365 /*************************************************************************
366  * calculate a SHA1 sum for the U-Boot image in Flash.
367  *
368  ************************************************************************/
369 static int pcs440ep_sha1 (int docheck)
370 {
371         unsigned char *data;
372         unsigned char *ptroff;
373         unsigned char output[20];
374         unsigned char org[20];
375         int     i, len = CONFIG_SHA1_LEN;
376
377         memcpy ((char *)CONFIG_SYS_LOAD_ADDR, (char *)CONFIG_SHA1_START, len);
378         data = (unsigned char *)CONFIG_SYS_LOAD_ADDR;
379         ptroff = &data[len + SHA1_SUM_POS];
380
381         for (i = 0; i < SHA1_SUM_LEN; i++) {
382                 org[i] = ptroff[i];
383                 ptroff[i] = 0;
384         }
385
386         sha1_csum ((unsigned char *) data, len, (unsigned char *)output);
387
388         if (docheck == 2) {
389                 for (i = 0; i < 20 ; i++) {
390                         printf("%02X ", output[i]);
391                 }
392                 printf("\n");
393         }
394         if (docheck == 1) {
395                 for (i = 0; i < 20 ; i++) {
396                         if (org[i] != output[i]) return 1;
397                 }
398         }
399         return 0;
400 }
401
402 /*************************************************************************
403  * do some checks after the SHA1 checksum from the U-Boot Image was
404  * calculated.
405  *
406  ************************************************************************/
407 static void pcs440ep_checksha1 (void)
408 {
409         int     ret;
410         char    *cs_test;
411
412         status_led_set (0, STATUS_LED_OFF);
413         status_led_set (1, STATUS_LED_OFF);
414         status_led_set (2, STATUS_LED_ON);
415         ret = pcs440ep_sha1 (1);
416         if (ret == 0) return;
417
418         if ((cs_test = getenv ("cs_test")) == NULL) {
419                 /* Env doesnt exist -> hang */
420                 status_led_blink ();
421                 /* here we do this "handy" because we have no interrupts
422                    at this time */
423                 puts ("### SHA1 ERROR ### Please RESET the board ###\n");
424                 for (;;) {
425                         __led_toggle (2);
426                         udelay (100000);
427                 }
428         }
429
430         if (strncmp (cs_test, "off", 3) == 0) {
431                 printf ("SHA1 U-Boot sum NOT ok!\n");
432                 setenv ("bootdelay", "-1");
433         }
434 }
435 #else
436 static __inline__ void pcs440ep_checksha1 (void) { do {} while (0);}
437 #endif
438
439 int misc_init_r (void)
440 {
441         uint pbcr;
442         int size_val = 0;
443
444         load_ethaddr();
445
446         /* Re-do sizing to get full correct info */
447         mtdcr(EBC0_CFGADDR, PB0CR);
448         pbcr = mfdcr(EBC0_CFGDATA);
449         switch (gd->bd->bi_flashsize) {
450         case 1 << 20:
451                 size_val = 0;
452                 break;
453         case 2 << 20:
454                 size_val = 1;
455                 break;
456         case 4 << 20:
457                 size_val = 2;
458                 break;
459         case 8 << 20:
460                 size_val = 3;
461                 break;
462         case 16 << 20:
463                 size_val = 4;
464                 break;
465         case 32 << 20:
466                 size_val = 5;
467                 break;
468         case 64 << 20:
469                 size_val = 6;
470                 break;
471         case 128 << 20:
472                 size_val = 7;
473                 break;
474         }
475         pbcr = (pbcr & 0x0001ffff) | gd->bd->bi_flashstart | (size_val << 17);
476         mtdcr(EBC0_CFGADDR, PB0CR);
477         mtdcr(EBC0_CFGDATA, pbcr);
478
479         /* adjust flash start and offset */
480         gd->bd->bi_flashstart = 0 - gd->bd->bi_flashsize;
481         gd->bd->bi_flashoffset = 0;
482
483         /* Monitor protection ON by default */
484         (void)flash_protect(FLAG_PROTECT_SET,
485                             -CONFIG_SYS_MONITOR_LEN,
486                             0xffffffff,
487                             &flash_info[1]);
488
489         /* Env protection ON by default */
490         (void)flash_protect(FLAG_PROTECT_SET,
491                             CONFIG_ENV_ADDR_REDUND,
492                             CONFIG_ENV_ADDR_REDUND + 2*CONFIG_ENV_SECT_SIZE - 1,
493                             &flash_info[1]);
494
495         pcs440ep_readinputs ();
496         pcs440ep_checksha1 ();
497 #ifdef CONFIG_PREBOOT
498         {
499                 struct kbd_data_t kbd_data;
500                 /* Decode keys */
501                 char *str = strdup (key_match (get_keys (&kbd_data)));
502                 /* Set or delete definition */
503                 setenv ("preboot", str);
504                 free (str);
505         }
506 #endif /* CONFIG_PREBOOT */
507         return 0;
508 }
509
510 int checkboard(void)
511 {
512         char *s = getenv("serial#");
513
514         printf("Board: PCS440EP");
515         if (s != NULL) {
516                 puts(", serial# ");
517                 puts(s);
518         }
519         putc('\n');
520
521         return (0);
522 }
523
524 void spd_ddr_init_hang (void)
525 {
526         status_led_set (0, STATUS_LED_OFF);
527         status_led_set (1, STATUS_LED_ON);
528         /* we cannot use hang() because we are still running from
529            Flash, and so the status_led driver is not initialized */
530         puts ("### SDRAM ERROR ### Please RESET the board ###\n");
531         for (;;) {
532                 __led_toggle (4);
533                 udelay (100000);
534         }
535 }
536
537 phys_size_t initdram (int board_type)
538 {
539         long dram_size = 0;
540
541         status_led_set (0, STATUS_LED_ON);
542         status_led_set (1, STATUS_LED_OFF);
543         dram_size = spd_sdram();
544         status_led_set (0, STATUS_LED_OFF);
545         status_led_set (1, STATUS_LED_ON);
546         if (dram_size == 0) {
547                 hang();
548         }
549
550         return dram_size;
551 }
552
553 /*************************************************************************
554  *  hw_watchdog_reset
555  *
556  *      This routine is called to reset (keep alive) the watchdog timer
557  *
558  ************************************************************************/
559 #if defined(CONFIG_HW_WATCHDOG)
560 void hw_watchdog_reset(void)
561 {
562
563 }
564 #endif
565
566 /*************************************************************************
567  * "led" Commando for the U-Boot shell
568  *
569  ************************************************************************/
570 int do_led (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
571 {
572         int     rcode = 0, i;
573         ulong   pattern = 0;
574
575         pattern = simple_strtoul (argv[1], NULL, 16);
576         if (pattern > 0x400) {
577                 int     val = GET_LEDS;
578                 printf ("led: %x\n", val);
579                 return rcode;
580         }
581         if (pattern > 0x200) {
582                 status_led_blink ();
583                 hang ();
584                 return rcode;
585         }
586         if (pattern > 0x100) {
587                 status_led_blink ();
588                 return rcode;
589         }
590         pattern &= 0x0f;
591         for (i = 0; i < 4; i++) {
592                 if (pattern & 0x01) status_led_set (i, STATUS_LED_ON);
593                 else status_led_set (i, STATUS_LED_OFF);
594                 pattern = pattern >> 1;
595         }
596         return rcode;
597 }
598
599 U_BOOT_CMD(
600         led,    2,      1,      do_led,
601         "set the DIAG-LED",
602         "[bitmask] 0x01 = DIAG 1 on\n"
603         "              0x02 = DIAG 2 on\n"
604         "              0x04 = DIAG 3 on\n"
605         "              0x08 = DIAG 4 on\n"
606         "              > 0x100 set the LED, who are on, to state blinking"
607 );
608
609 #if defined(CONFIG_SHA1_CHECK_UB_IMG)
610 /*************************************************************************
611  * "sha1" Commando for the U-Boot shell
612  *
613  ************************************************************************/
614 int do_sha1 (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
615 {
616         int     rcode = -1;
617
618         if (argc < 2) {
619 usage:
620                 return cmd_usage(cmdtp);
621         }
622
623         if (argc >= 3) {
624                 unsigned char *data;
625                 unsigned char output[20];
626                 int     len;
627                 int     i;
628
629                 data = (unsigned char *)simple_strtoul (argv[1], NULL, 16);
630                 len = simple_strtoul (argv[2], NULL, 16);
631                 sha1_csum (data, len, (unsigned char *)output);
632                 printf ("U-Boot sum:\n");
633                 for (i = 0; i < 20 ; i++) {
634                         printf ("%02X ", output[i]);
635                 }
636                 printf ("\n");
637                 if (argc == 4) {
638                         data = (unsigned char *)simple_strtoul (argv[3], NULL, 16);
639                         memcpy (data, output, 20);
640                 }
641                 return 0;
642         }
643         if (argc == 2) {
644                 char *ptr = argv[1];
645                 if (*ptr != '-') goto usage;
646                 ptr++;
647                 if ((*ptr == 'c') || (*ptr == 'C')) {
648                         rcode = pcs440ep_sha1 (1);
649                         printf ("SHA1 U-Boot sum %sok!\n", (rcode != 0) ? "not " : "");
650                 } else if ((*ptr == 'p') || (*ptr == 'P')) {
651                         rcode = pcs440ep_sha1 (2);
652                 } else {
653                         rcode = pcs440ep_sha1 (0);
654                 }
655                 return rcode;
656         }
657         return rcode;
658 }
659
660 U_BOOT_CMD(
661         sha1,   4,      1,      do_sha1,
662         "calculate the SHA1 Sum",
663         "address len [addr]  calculate the SHA1 sum [save at addr]\n"
664         "     -p calculate the SHA1 sum from the U-Boot image in flash and print\n"
665         "     -c check the U-Boot image in flash"
666 );
667 #endif
668
669 #if defined (CONFIG_CMD_IDE)
670 /* These addresses need to be shifted one place to the left
671  * ( bus per_addr 20 -30 is connectsd on CF bus A10-A0)
672  * These values are shifted
673  */
674 extern ulong *ide_bus_offset;
675 void inline ide_outb(int dev, int port, unsigned char val)
676 {
677         debug ("ide_outb (dev= %d, port= 0x%x, val= 0x%02x) : @ 0x%08lx\n",
678                 dev, port, val, (ATA_CURR_BASE(dev)+port));
679
680         out_be16((u16 *)(ATA_CURR_BASE(dev)+(port << 1)), val);
681 }
682 unsigned char inline ide_inb(int dev, int port)
683 {
684         uchar val;
685         val = in_be16((u16 *)(ATA_CURR_BASE(dev)+(port << 1)));
686         debug ("ide_inb (dev= %d, port= 0x%x) : @ 0x%08lx -> 0x%02x\n",
687                 dev, port, (ATA_CURR_BASE(dev)+port), val);
688         return (val);
689 }
690 #endif
691
692 #ifdef CONFIG_IDE_PREINIT
693 int ide_preinit (void)
694 {
695         /* Set True IDE Mode */
696         out32 (GPIO0_OR, (in32 (GPIO0_OR) | 0x00100000));
697         out32 (GPIO0_OR, (in32 (GPIO0_OR) | 0x00200000));
698         out32 (GPIO1_OR, (in32 (GPIO1_OR) & ~0x00008040));
699         udelay (100000);
700         return 0;
701 }
702 #endif
703
704 #if defined (CONFIG_CMD_IDE) && defined (CONFIG_IDE_RESET)
705 void ide_set_reset (int idereset)
706 {
707         debug ("ide_reset(%d)\n", idereset);
708         if (idereset == 0) {
709                 out32 (GPIO0_OR, (in32 (GPIO0_OR) | 0x00200000));
710         } else {
711                 out32 (GPIO0_OR, (in32 (GPIO0_OR) & ~0x00200000));
712         }
713         udelay (10000);
714 }
715 #endif /* defined (CONFIG_CMD_IDE) && defined (CONFIG_IDE_RESET) */