wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 1 | /* |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 2 | * (C) Copyright 2000-2004 |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
| 4 | * Klaus Heydeck, Kieback & Peter GmbH & Co KG, heydeck@kieback-peter.de |
| 5 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 6 | * SPDX-License-Identifier: GPL-2.0+ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 7 | */ |
| 8 | |
| 9 | #include <common.h> |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 10 | #include <command.h> |
Heiko Schocher | 4367b8d | 2010-07-19 23:47:08 +0200 | [diff] [blame] | 11 | #include <libfdt.h> |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 12 | #include <mpc8xx.h> |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 13 | #include <hwconfig.h> |
| 14 | #include <i2c.h> |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 15 | #include "../common/kup.h" |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 16 | #include <asm/io.h> |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 17 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 18 | static unsigned char swapbyte(unsigned char c); |
| 19 | static int read_diag(void); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 20 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 21 | DECLARE_GLOBAL_DATA_PTR; |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 22 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 23 | /* ----------------------------------------------------------------------- */ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 24 | |
| 25 | #define _NOT_USED_ 0xFFFFFFFF |
| 26 | |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 27 | const uint sdram_table[] = { |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 28 | /* |
| 29 | * Single Read. (Offset 0 in UPMA RAM) |
| 30 | */ |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 31 | 0x1F07FC04, 0xEEAEFC04, 0x11ADFC04, 0xEFBBBC00, |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 32 | 0x1FF77C47, /* last */ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 33 | |
| 34 | /* |
| 35 | * SDRAM Initialization (offset 5 in UPMA RAM) |
| 36 | * |
| 37 | * This is no UPM entry point. The following definition uses |
| 38 | * the remaining space to establish an initialization |
| 39 | * sequence, which is executed by a RUN command. |
| 40 | * |
| 41 | */ |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 42 | 0x1FF77C35, 0xEFEABC34, 0x1FB57C35, /* last */ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 43 | |
| 44 | /* |
| 45 | * Burst Read. (Offset 8 in UPMA RAM) |
| 46 | */ |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 47 | 0x1F07FC04, 0xEEAEFC04, 0x10ADFC04, 0xF0AFFC00, |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 48 | 0xF0AFFC00, 0xF1AFFC00, 0xEFBBBC00, 0x1FF77C47, /* last */ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 49 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, |
| 50 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, |
| 51 | |
| 52 | /* |
| 53 | * Single Write. (Offset 18 in UPMA RAM) |
| 54 | */ |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 55 | 0x1F27FC04, 0xEEAEBC00, 0x01B93C04, 0x1FF77C47, /* last */ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 56 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, |
| 57 | |
| 58 | /* |
| 59 | * Burst Write. (Offset 20 in UPMA RAM) |
| 60 | */ |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 61 | 0x1F07FC04, 0xEEAEBC00, 0x10AD7C00, 0xF0AFFC00, |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 62 | 0xF0AFFC00, 0xE1BBBC04, 0x1FF77C47, /* last */ |
| 63 | _NOT_USED_, |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 64 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, |
| 65 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, |
| 66 | |
| 67 | /* |
| 68 | * Refresh (Offset 30 in UPMA RAM) |
| 69 | */ |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 70 | 0x1FF5FC84, 0xFFFFFC04, 0xFFFFFC04, 0xFFFFFC04, |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 71 | 0xFFFFFC84, 0xFFFFFC07, /* last */ |
| 72 | _NOT_USED_, _NOT_USED_, |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 73 | _NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_, |
| 74 | |
| 75 | /* |
| 76 | * Exception. (Offset 3c in UPMA RAM) |
| 77 | */ |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 78 | 0x7FFFFC07, /* last */ |
| 79 | _NOT_USED_, _NOT_USED_, _NOT_USED_, |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 80 | }; |
| 81 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 82 | /* ----------------------------------------------------------------------- */ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 83 | |
| 84 | /* |
| 85 | * Check Board Identity: |
| 86 | */ |
| 87 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 88 | int checkboard(void) |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 89 | { |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 90 | volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR; |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 91 | uchar rev,mod,tmp,pcf,ak_rev,ak_mod; |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 92 | |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 93 | /* |
| 94 | * Init ChipSelect #4 (CAN + HW-Latch) |
| 95 | */ |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 96 | out_be32(&immap->im_memctl.memc_or4, CONFIG_SYS_OR4); |
| 97 | out_be32(&immap->im_memctl.memc_br4, CONFIG_SYS_BR4); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 98 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 99 | /* |
| 100 | * Init ChipSelect #5 (S1D13768) |
| 101 | */ |
| 102 | out_be32(&immap->im_memctl.memc_or5, CONFIG_SYS_OR5); |
| 103 | out_be32(&immap->im_memctl.memc_br5, CONFIG_SYS_BR5); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 104 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 105 | tmp = swapbyte(in_8((unsigned char*) LATCH_ADDR)); |
| 106 | rev = (tmp & 0xF8) >> 3; |
| 107 | mod = (tmp & 0x07); |
| 108 | |
| 109 | i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 110 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 111 | if (read_diag()) |
| 112 | gd->flags &= ~GD_FLG_SILENT; |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 113 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 114 | printf("Board: KUP4K Rev %d.%d AK:",rev,mod); |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 115 | /* |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 116 | * TI Application report: Before using the IO as an input, |
| 117 | * a high must be written to the IO first |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 118 | */ |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 119 | pcf = 0xFF; |
| 120 | i2c_write(0x21, 0, 0 , &pcf, 1); |
| 121 | if (i2c_read(0x21, 0, 0, &pcf, 1)) { |
| 122 | puts("n/a\n"); |
| 123 | } else { |
| 124 | ak_rev = (pcf & 0xF8) >> 3; |
| 125 | ak_mod = (pcf & 0x07); |
| 126 | printf("%d.%d\n", ak_rev, ak_mod); |
| 127 | } |
| 128 | return 0; |
| 129 | } |
| 130 | |
| 131 | /* ----------------------------------------------------------------------- */ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 132 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 133 | |
| 134 | phys_size_t initdram(int board_type) |
| 135 | { |
| 136 | volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR; |
| 137 | volatile memctl8xx_t *memctl = &immap->im_memctl; |
| 138 | long int size = 0; |
Wolfgang Denk | 0692404 | 2011-11-04 15:55:34 +0000 | [diff] [blame] | 139 | uchar *latch, rev, tmp; |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 140 | |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 141 | /* |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 142 | * Init ChipSelect #4 (CAN + HW-Latch) to determine Hardware Revision |
| 143 | * Rev 1..6 -> 48 MB RAM; Rev >= 7 -> 96 MB |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 144 | */ |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 145 | out_be32(&immap->im_memctl.memc_or4, CONFIG_SYS_OR4); |
| 146 | out_be32(&immap->im_memctl.memc_br4, CONFIG_SYS_BR4); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 147 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 148 | latch = (uchar *)0x90000200; |
| 149 | tmp = swapbyte(*latch); |
| 150 | rev = (tmp & 0xF8) >> 3; |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 151 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 152 | upmconfig(UPMA, (uint *) sdram_table, |
| 153 | sizeof (sdram_table) / sizeof (uint)); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 154 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 155 | out_be16(&memctl->memc_mptpr, CONFIG_SYS_MPTPR); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 156 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 157 | out_be32(&memctl->memc_mar, 0x00000088); |
| 158 | /* no refresh yet */ |
| 159 | if(rev >= 7) { |
| 160 | out_be32(&memctl->memc_mamr, |
| 161 | CONFIG_SYS_MAMR_9COL & (~(MAMR_PTAE))); |
| 162 | } else { |
| 163 | out_be32(&memctl->memc_mamr, |
| 164 | CONFIG_SYS_MAMR_8COL & (~(MAMR_PTAE))); |
| 165 | } |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 166 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 167 | udelay(200); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 168 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 169 | /* perform SDRAM initializsation sequence */ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 170 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 171 | /* SDRAM bank 0 */ |
| 172 | out_be32(&memctl->memc_mcr, 0x80002105); |
| 173 | udelay(1); |
| 174 | out_be32(&memctl->memc_mcr, 0x80002830); /* execute twice */ |
| 175 | udelay(1); |
| 176 | out_be32(&memctl->memc_mcr, 0x80002106); /* RUN MRS Pattern from loc 6 */ |
| 177 | udelay(1); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 178 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 179 | /* SDRAM bank 1 */ |
| 180 | out_be32(&memctl->memc_mcr, 0x80004105); |
| 181 | udelay(1); |
| 182 | out_be32(&memctl->memc_mcr, 0x80004830); /* execute twice */ |
| 183 | udelay(1); |
| 184 | out_be32(&memctl->memc_mcr, 0x80004106); /* RUN MRS Pattern from loc 6 */ |
| 185 | udelay(1); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 186 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 187 | /* SDRAM bank 2 */ |
| 188 | out_be32(&memctl->memc_mcr, 0x80006105); |
| 189 | udelay(1); |
| 190 | out_be32(&memctl->memc_mcr, 0x80006830); /* execute twice */ |
| 191 | udelay(1); |
| 192 | out_be32(&memctl->memc_mcr, 0x80006106); /* RUN MRS Pattern from loc 6 */ |
| 193 | udelay(1); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 194 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 195 | setbits_be32(&memctl->memc_mamr, MAMR_PTAE); /* enable refresh */ |
| 196 | udelay(1000); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 197 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 198 | out_be16(&memctl->memc_mptpr, CONFIG_SYS_MPTPR); |
| 199 | udelay(1000); |
| 200 | if(rev >= 7) { |
| 201 | size = 32 * 3 * 1024 * 1024; |
| 202 | out_be32(&memctl->memc_or1, CONFIG_SYS_OR1_9COL); |
| 203 | out_be32(&memctl->memc_br1, CONFIG_SYS_BR1_9COL); |
| 204 | out_be32(&memctl->memc_or2, CONFIG_SYS_OR2_9COL); |
| 205 | out_be32(&memctl->memc_br2, CONFIG_SYS_BR2_9COL); |
| 206 | out_be32(&memctl->memc_or3, CONFIG_SYS_OR3_9COL); |
| 207 | out_be32(&memctl->memc_br3, CONFIG_SYS_BR3_9COL); |
| 208 | } else { |
| 209 | size = 16 * 3 * 1024 * 1024; |
| 210 | out_be32(&memctl->memc_or1, CONFIG_SYS_OR1_8COL); |
| 211 | out_be32(&memctl->memc_br1, CONFIG_SYS_BR1_8COL); |
| 212 | out_be32(&memctl->memc_or2, CONFIG_SYS_OR2_8COL); |
| 213 | out_be32(&memctl->memc_br2, CONFIG_SYS_BR2_8COL); |
| 214 | out_be32(&memctl->memc_or3, CONFIG_SYS_OR3_8COL); |
| 215 | out_be32(&memctl->memc_br3, CONFIG_SYS_BR3_8COL); |
| 216 | } |
| 217 | return (size); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 218 | } |
| 219 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 220 | /* ----------------------------------------------------------------------- */ |
| 221 | |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 222 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 223 | int misc_init_r(void) |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 224 | { |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 225 | volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR; |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 226 | |
wdenk | 90e7e42 | 2002-12-04 23:39:58 +0000 | [diff] [blame] | 227 | #ifdef CONFIG_IDE_LED |
| 228 | /* Configure PA8 as output port */ |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 229 | setbits_be16(&immap->im_ioport.iop_padir, PA_8); |
| 230 | setbits_be16(&immap->im_ioport.iop_paodr, PA_8); |
| 231 | clrbits_be16(&immap->im_ioport.iop_papar, PA_8); |
| 232 | setbits_be16(&immap->im_ioport.iop_padat, PA_8); /* turn it off */ |
wdenk | 90e7e42 | 2002-12-04 23:39:58 +0000 | [diff] [blame] | 233 | #endif |
Mike Frysinger | dcc95c4 | 2009-02-11 20:09:52 -0500 | [diff] [blame] | 234 | load_sernum_ethaddr(); |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 235 | setenv("hw","4k"); |
| 236 | poweron_key(); |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 237 | return (0); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 238 | } |
| 239 | |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 240 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 241 | static int read_diag(void) |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 242 | { |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 243 | int diag; |
| 244 | immap_t *immr = (immap_t *)CONFIG_SYS_IMMR; |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 245 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 246 | clrbits_be16(&immr->im_ioport.iop_pcdir, PC_4); /* input */ |
| 247 | clrbits_be16(&immr->im_ioport.iop_pcpar, PC_4); /* gpio */ |
| 248 | setbits_be16(&immr->im_ioport.iop_pcdir, PC_5); /* output */ |
| 249 | clrbits_be16(&immr->im_ioport.iop_pcpar, PC_4); /* gpio */ |
| 250 | setbits_be16(&immr->im_ioport.iop_pcdat, PC_5); /* 1 */ |
| 251 | udelay(500); |
| 252 | if (in_be16(&immr->im_ioport.iop_pcdat) & PC_4) { |
| 253 | clrbits_be16(&immr->im_ioport.iop_pcdat, PC_5);/* 0 */ |
| 254 | udelay(500); |
| 255 | if(in_be16(&immr->im_ioport.iop_pcdat) & PC_4) |
| 256 | diag = 0; |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 257 | else |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 258 | diag = 1; |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 259 | } else { |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 260 | diag = 0; |
wdenk | 65faef9 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 261 | } |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 262 | clrbits_be16(&immr->im_ioport.iop_pcdir, PC_5); /* input */ |
| 263 | return (diag); |
| 264 | } |
wdenk | 4e112c1 | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 265 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 266 | static unsigned char swapbyte(unsigned char c) |
| 267 | { |
| 268 | unsigned char result = 0; |
| 269 | int i = 0; |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 270 | |
Heiko Schocher | 4c934d0 | 2010-07-19 23:46:48 +0200 | [diff] [blame] | 271 | for(i = 0; i < 8; ++i) { |
| 272 | result = result << 1; |
| 273 | result |= (c & 1); |
| 274 | c = c >> 1; |
| 275 | } |
| 276 | return result; |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 277 | } |
Heiko Schocher | 4367b8d | 2010-07-19 23:47:08 +0200 | [diff] [blame] | 278 | |
| 279 | /* |
| 280 | * Device Tree Support |
| 281 | */ |
| 282 | #if defined(CONFIG_OF_BOARD_SETUP) && defined(CONFIG_OF_LIBFDT) |
| 283 | void ft_board_setup(void *blob, bd_t *bd) |
| 284 | { |
| 285 | ft_cpu_setup(blob, bd); |
| 286 | } |
| 287 | #endif /* defined(CONFIG_OF_BOARD_SETUP) && defined(CONFIG_OF_LIBFDT) */ |