mx6qsabrelite.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511
  1. /*
  2. * Copyright (C) 2010-2011 Freescale Semiconductor, Inc.
  3. *
  4. * See file CREDITS for list of people who contributed to this
  5. * project.
  6. *
  7. * This program is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU General Public License as
  9. * published by the Free Software Foundation; either version 2 of
  10. * the License, or (at your option) any later version.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  20. * MA 02111-1307 USA
  21. */
  22. #include <common.h>
  23. #include <asm/io.h>
  24. #include <asm/arch/clock.h>
  25. #include <asm/arch/imx-regs.h>
  26. #include <asm/arch/iomux.h>
  27. #include <asm/arch/mx6x_pins.h>
  28. #include <asm/errno.h>
  29. #include <asm/gpio.h>
  30. #include <asm/imx-common/iomux-v3.h>
  31. #include <asm/imx-common/mxc_i2c.h>
  32. #include <asm/imx-common/boot_mode.h>
  33. #include <mmc.h>
  34. #include <fsl_esdhc.h>
  35. #include <micrel.h>
  36. #include <miiphy.h>
  37. #include <netdev.h>
  38. DECLARE_GLOBAL_DATA_PTR;
  39. #define UART_PAD_CTRL (PAD_CTL_PKE | PAD_CTL_PUE | \
  40. PAD_CTL_PUS_100K_UP | PAD_CTL_SPEED_MED | \
  41. PAD_CTL_DSE_40ohm | PAD_CTL_SRE_FAST | PAD_CTL_HYS)
  42. #define USDHC_PAD_CTRL (PAD_CTL_PKE | PAD_CTL_PUE | \
  43. PAD_CTL_PUS_47K_UP | PAD_CTL_SPEED_LOW | \
  44. PAD_CTL_DSE_80ohm | PAD_CTL_SRE_FAST | PAD_CTL_HYS)
  45. #define ENET_PAD_CTRL (PAD_CTL_PKE | PAD_CTL_PUE | \
  46. PAD_CTL_PUS_100K_UP | PAD_CTL_SPEED_MED | \
  47. PAD_CTL_DSE_40ohm | PAD_CTL_HYS)
  48. #define SPI_PAD_CTRL (PAD_CTL_HYS | \
  49. PAD_CTL_PUS_100K_DOWN | PAD_CTL_SPEED_MED | \
  50. PAD_CTL_DSE_40ohm | PAD_CTL_SRE_FAST)
  51. #define BUTTON_PAD_CTRL (PAD_CTL_PKE | PAD_CTL_PUE | \
  52. PAD_CTL_PUS_100K_UP | PAD_CTL_SPEED_MED | \
  53. PAD_CTL_DSE_40ohm | PAD_CTL_HYS)
  54. #define I2C_PAD_CTRL (PAD_CTL_PKE | PAD_CTL_PUE | \
  55. PAD_CTL_PUS_100K_UP | PAD_CTL_SPEED_MED | \
  56. PAD_CTL_DSE_40ohm | PAD_CTL_HYS | \
  57. PAD_CTL_ODE | PAD_CTL_SRE_FAST)
  58. int dram_init(void)
  59. {
  60. gd->ram_size = get_ram_size((void *)PHYS_SDRAM, PHYS_SDRAM_SIZE);
  61. return 0;
  62. }
  63. iomux_v3_cfg_t uart1_pads[] = {
  64. MX6Q_PAD_SD3_DAT6__UART1_RXD | MUX_PAD_CTRL(UART_PAD_CTRL),
  65. MX6Q_PAD_SD3_DAT7__UART1_TXD | MUX_PAD_CTRL(UART_PAD_CTRL),
  66. };
  67. iomux_v3_cfg_t uart2_pads[] = {
  68. MX6Q_PAD_EIM_D26__UART2_TXD | MUX_PAD_CTRL(UART_PAD_CTRL),
  69. MX6Q_PAD_EIM_D27__UART2_RXD | MUX_PAD_CTRL(UART_PAD_CTRL),
  70. };
  71. #define PC MUX_PAD_CTRL(I2C_PAD_CTRL)
  72. /* I2C1, SGTL5000 */
  73. struct i2c_pads_info i2c_pad_info0 = {
  74. .scl = {
  75. .i2c_mode = MX6Q_PAD_EIM_D21__I2C1_SCL | PC,
  76. .gpio_mode = MX6Q_PAD_EIM_D21__GPIO_3_21 | PC,
  77. .gp = IMX_GPIO_NR(3, 21)
  78. },
  79. .sda = {
  80. .i2c_mode = MX6Q_PAD_EIM_D28__I2C1_SDA | PC,
  81. .gpio_mode = MX6Q_PAD_EIM_D28__GPIO_3_28 | PC,
  82. .gp = IMX_GPIO_NR(3, 28)
  83. }
  84. };
  85. /* I2C2 Camera, MIPI */
  86. struct i2c_pads_info i2c_pad_info1 = {
  87. .scl = {
  88. .i2c_mode = MX6Q_PAD_KEY_COL3__I2C2_SCL | PC,
  89. .gpio_mode = MX6Q_PAD_KEY_COL3__GPIO_4_12 | PC,
  90. .gp = IMX_GPIO_NR(4, 12)
  91. },
  92. .sda = {
  93. .i2c_mode = MX6Q_PAD_KEY_ROW3__I2C2_SDA | PC,
  94. .gpio_mode = MX6Q_PAD_KEY_ROW3__GPIO_4_13 | PC,
  95. .gp = IMX_GPIO_NR(4, 13)
  96. }
  97. };
  98. /* I2C3, J15 - RGB connector */
  99. struct i2c_pads_info i2c_pad_info2 = {
  100. .scl = {
  101. .i2c_mode = MX6Q_PAD_GPIO_5__I2C3_SCL | PC,
  102. .gpio_mode = MX6Q_PAD_GPIO_5__GPIO_1_5 | PC,
  103. .gp = IMX_GPIO_NR(1, 5)
  104. },
  105. .sda = {
  106. .i2c_mode = MX6Q_PAD_GPIO_16__I2C3_SDA | PC,
  107. .gpio_mode = MX6Q_PAD_GPIO_16__GPIO_7_11 | PC,
  108. .gp = IMX_GPIO_NR(7, 11)
  109. }
  110. };
  111. iomux_v3_cfg_t usdhc3_pads[] = {
  112. MX6Q_PAD_SD3_CLK__USDHC3_CLK | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  113. MX6Q_PAD_SD3_CMD__USDHC3_CMD | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  114. MX6Q_PAD_SD3_DAT0__USDHC3_DAT0 | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  115. MX6Q_PAD_SD3_DAT1__USDHC3_DAT1 | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  116. MX6Q_PAD_SD3_DAT2__USDHC3_DAT2 | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  117. MX6Q_PAD_SD3_DAT3__USDHC3_DAT3 | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  118. MX6Q_PAD_SD3_DAT5__GPIO_7_0 | MUX_PAD_CTRL(NO_PAD_CTRL), /* CD */
  119. };
  120. iomux_v3_cfg_t usdhc4_pads[] = {
  121. MX6Q_PAD_SD4_CLK__USDHC4_CLK | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  122. MX6Q_PAD_SD4_CMD__USDHC4_CMD | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  123. MX6Q_PAD_SD4_DAT0__USDHC4_DAT0 | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  124. MX6Q_PAD_SD4_DAT1__USDHC4_DAT1 | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  125. MX6Q_PAD_SD4_DAT2__USDHC4_DAT2 | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  126. MX6Q_PAD_SD4_DAT3__USDHC4_DAT3 | MUX_PAD_CTRL(USDHC_PAD_CTRL),
  127. MX6Q_PAD_NANDF_D6__GPIO_2_6 | MUX_PAD_CTRL(NO_PAD_CTRL), /* CD */
  128. };
  129. iomux_v3_cfg_t enet_pads1[] = {
  130. MX6Q_PAD_ENET_MDIO__ENET_MDIO | MUX_PAD_CTRL(ENET_PAD_CTRL),
  131. MX6Q_PAD_ENET_MDC__ENET_MDC | MUX_PAD_CTRL(ENET_PAD_CTRL),
  132. MX6Q_PAD_RGMII_TXC__ENET_RGMII_TXC | MUX_PAD_CTRL(ENET_PAD_CTRL),
  133. MX6Q_PAD_RGMII_TD0__ENET_RGMII_TD0 | MUX_PAD_CTRL(ENET_PAD_CTRL),
  134. MX6Q_PAD_RGMII_TD1__ENET_RGMII_TD1 | MUX_PAD_CTRL(ENET_PAD_CTRL),
  135. MX6Q_PAD_RGMII_TD2__ENET_RGMII_TD2 | MUX_PAD_CTRL(ENET_PAD_CTRL),
  136. MX6Q_PAD_RGMII_TD3__ENET_RGMII_TD3 | MUX_PAD_CTRL(ENET_PAD_CTRL),
  137. MX6Q_PAD_RGMII_TX_CTL__RGMII_TX_CTL | MUX_PAD_CTRL(ENET_PAD_CTRL),
  138. MX6Q_PAD_ENET_REF_CLK__ENET_TX_CLK | MUX_PAD_CTRL(ENET_PAD_CTRL),
  139. /* pin 35 - 1 (PHY_AD2) on reset */
  140. MX6Q_PAD_RGMII_RXC__GPIO_6_30 | MUX_PAD_CTRL(NO_PAD_CTRL),
  141. /* pin 32 - 1 - (MODE0) all */
  142. MX6Q_PAD_RGMII_RD0__GPIO_6_25 | MUX_PAD_CTRL(NO_PAD_CTRL),
  143. /* pin 31 - 1 - (MODE1) all */
  144. MX6Q_PAD_RGMII_RD1__GPIO_6_27 | MUX_PAD_CTRL(NO_PAD_CTRL),
  145. /* pin 28 - 1 - (MODE2) all */
  146. MX6Q_PAD_RGMII_RD2__GPIO_6_28 | MUX_PAD_CTRL(NO_PAD_CTRL),
  147. /* pin 27 - 1 - (MODE3) all */
  148. MX6Q_PAD_RGMII_RD3__GPIO_6_29 | MUX_PAD_CTRL(NO_PAD_CTRL),
  149. /* pin 33 - 1 - (CLK125_EN) 125Mhz clockout enabled */
  150. MX6Q_PAD_RGMII_RX_CTL__GPIO_6_24 | MUX_PAD_CTRL(NO_PAD_CTRL),
  151. /* pin 42 PHY nRST */
  152. MX6Q_PAD_EIM_D23__GPIO_3_23 | MUX_PAD_CTRL(NO_PAD_CTRL),
  153. };
  154. iomux_v3_cfg_t enet_pads2[] = {
  155. MX6Q_PAD_RGMII_RXC__ENET_RGMII_RXC | MUX_PAD_CTRL(ENET_PAD_CTRL),
  156. MX6Q_PAD_RGMII_RD0__ENET_RGMII_RD0 | MUX_PAD_CTRL(ENET_PAD_CTRL),
  157. MX6Q_PAD_RGMII_RD1__ENET_RGMII_RD1 | MUX_PAD_CTRL(ENET_PAD_CTRL),
  158. MX6Q_PAD_RGMII_RD2__ENET_RGMII_RD2 | MUX_PAD_CTRL(ENET_PAD_CTRL),
  159. MX6Q_PAD_RGMII_RD3__ENET_RGMII_RD3 | MUX_PAD_CTRL(ENET_PAD_CTRL),
  160. MX6Q_PAD_RGMII_RX_CTL__RGMII_RX_CTL | MUX_PAD_CTRL(ENET_PAD_CTRL),
  161. };
  162. /* Button assignments for J14 */
  163. static iomux_v3_cfg_t button_pads[] = {
  164. /* Menu */
  165. MX6Q_PAD_NANDF_D1__GPIO_2_1 | MUX_PAD_CTRL(BUTTON_PAD_CTRL),
  166. /* Back */
  167. MX6Q_PAD_NANDF_D2__GPIO_2_2 | MUX_PAD_CTRL(BUTTON_PAD_CTRL),
  168. /* Labelled Search (mapped to Power under Android) */
  169. MX6Q_PAD_NANDF_D3__GPIO_2_3 | MUX_PAD_CTRL(BUTTON_PAD_CTRL),
  170. /* Home */
  171. MX6Q_PAD_NANDF_D4__GPIO_2_4 | MUX_PAD_CTRL(BUTTON_PAD_CTRL),
  172. /* Volume Down */
  173. MX6Q_PAD_GPIO_19__GPIO_4_5 | MUX_PAD_CTRL(BUTTON_PAD_CTRL),
  174. /* Volume Up */
  175. MX6Q_PAD_GPIO_18__GPIO_7_13 | MUX_PAD_CTRL(BUTTON_PAD_CTRL),
  176. };
  177. static void setup_iomux_enet(void)
  178. {
  179. gpio_direction_output(87, 0); /* GPIO 3-23 */
  180. gpio_direction_output(190, 1); /* GPIO 6-30 */
  181. gpio_direction_output(185, 1); /* GPIO 6-25 */
  182. gpio_direction_output(187, 1); /* GPIO 6-27 */
  183. gpio_direction_output(188, 1); /* GPIO 6-28*/
  184. gpio_direction_output(189, 1); /* GPIO 6-29 */
  185. imx_iomux_v3_setup_multiple_pads(enet_pads1, ARRAY_SIZE(enet_pads1));
  186. gpio_direction_output(184, 1); /* GPIO 6-24 */
  187. /* Need delay 10ms according to KSZ9021 spec */
  188. udelay(1000 * 10);
  189. gpio_set_value(87, 1); /* GPIO 3-23 */
  190. imx_iomux_v3_setup_multiple_pads(enet_pads2, ARRAY_SIZE(enet_pads2));
  191. }
  192. iomux_v3_cfg_t usb_pads[] = {
  193. MX6Q_PAD_GPIO_17__GPIO_7_12 | MUX_PAD_CTRL(NO_PAD_CTRL),
  194. };
  195. static void setup_iomux_uart(void)
  196. {
  197. imx_iomux_v3_setup_multiple_pads(uart1_pads, ARRAY_SIZE(uart1_pads));
  198. imx_iomux_v3_setup_multiple_pads(uart2_pads, ARRAY_SIZE(uart2_pads));
  199. }
  200. #ifdef CONFIG_USB_EHCI_MX6
  201. int board_ehci_hcd_init(int port)
  202. {
  203. imx_iomux_v3_setup_multiple_pads(usb_pads, ARRAY_SIZE(usb_pads));
  204. /* Reset USB hub */
  205. gpio_direction_output(IMX_GPIO_NR(7, 12), 0);
  206. mdelay(2);
  207. gpio_set_value(IMX_GPIO_NR(7, 12), 1);
  208. return 0;
  209. }
  210. #endif
  211. #ifdef CONFIG_FSL_ESDHC
  212. struct fsl_esdhc_cfg usdhc_cfg[2] = {
  213. {USDHC3_BASE_ADDR, 1},
  214. {USDHC4_BASE_ADDR, 1},
  215. };
  216. int board_mmc_getcd(struct mmc *mmc)
  217. {
  218. struct fsl_esdhc_cfg *cfg = (struct fsl_esdhc_cfg *)mmc->priv;
  219. int ret;
  220. if (cfg->esdhc_base == USDHC3_BASE_ADDR) {
  221. gpio_direction_input(192); /*GPIO7_0*/
  222. ret = !gpio_get_value(192);
  223. } else {
  224. gpio_direction_input(38); /*GPIO2_6*/
  225. ret = !gpio_get_value(38);
  226. }
  227. return ret;
  228. }
  229. int board_mmc_init(bd_t *bis)
  230. {
  231. s32 status = 0;
  232. u32 index = 0;
  233. for (index = 0; index < CONFIG_SYS_FSL_USDHC_NUM; ++index) {
  234. switch (index) {
  235. case 0:
  236. imx_iomux_v3_setup_multiple_pads(
  237. usdhc3_pads, ARRAY_SIZE(usdhc3_pads));
  238. break;
  239. case 1:
  240. imx_iomux_v3_setup_multiple_pads(
  241. usdhc4_pads, ARRAY_SIZE(usdhc4_pads));
  242. break;
  243. default:
  244. printf("Warning: you configured more USDHC controllers"
  245. "(%d) then supported by the board (%d)\n",
  246. index + 1, CONFIG_SYS_FSL_USDHC_NUM);
  247. return status;
  248. }
  249. status |= fsl_esdhc_initialize(bis, &usdhc_cfg[index]);
  250. }
  251. return status;
  252. }
  253. #endif
  254. u32 get_board_rev(void)
  255. {
  256. return 0x63000 ;
  257. }
  258. #ifdef CONFIG_MXC_SPI
  259. iomux_v3_cfg_t ecspi1_pads[] = {
  260. /* SS1 */
  261. MX6Q_PAD_EIM_D19__GPIO_3_19 | MUX_PAD_CTRL(SPI_PAD_CTRL),
  262. MX6Q_PAD_EIM_D17__ECSPI1_MISO | MUX_PAD_CTRL(SPI_PAD_CTRL),
  263. MX6Q_PAD_EIM_D18__ECSPI1_MOSI | MUX_PAD_CTRL(SPI_PAD_CTRL),
  264. MX6Q_PAD_EIM_D16__ECSPI1_SCLK | MUX_PAD_CTRL(SPI_PAD_CTRL),
  265. };
  266. void setup_spi(void)
  267. {
  268. gpio_direction_output(CONFIG_SF_DEFAULT_CS, 1);
  269. imx_iomux_v3_setup_multiple_pads(ecspi1_pads,
  270. ARRAY_SIZE(ecspi1_pads));
  271. }
  272. #endif
  273. int board_phy_config(struct phy_device *phydev)
  274. {
  275. /* min rx data delay */
  276. ksz9021_phy_extended_write(phydev,
  277. MII_KSZ9021_EXT_RGMII_RX_DATA_SKEW, 0x0);
  278. /* min tx data delay */
  279. ksz9021_phy_extended_write(phydev,
  280. MII_KSZ9021_EXT_RGMII_TX_DATA_SKEW, 0x0);
  281. /* max rx/tx clock delay, min rx/tx control */
  282. ksz9021_phy_extended_write(phydev,
  283. MII_KSZ9021_EXT_RGMII_CLOCK_SKEW, 0xf0f0);
  284. if (phydev->drv->config)
  285. phydev->drv->config(phydev);
  286. return 0;
  287. }
  288. int board_eth_init(bd_t *bis)
  289. {
  290. int ret;
  291. setup_iomux_enet();
  292. ret = cpu_eth_init(bis);
  293. if (ret)
  294. printf("FEC MXC: %s:failed\n", __func__);
  295. return 0;
  296. }
  297. static void setup_buttons(void)
  298. {
  299. imx_iomux_v3_setup_multiple_pads(button_pads,
  300. ARRAY_SIZE(button_pads));
  301. }
  302. #ifdef CONFIG_CMD_SATA
  303. int setup_sata(void)
  304. {
  305. struct iomuxc_base_regs *const iomuxc_regs
  306. = (struct iomuxc_base_regs *) IOMUXC_BASE_ADDR;
  307. int ret = enable_sata_clock();
  308. if (ret)
  309. return ret;
  310. clrsetbits_le32(&iomuxc_regs->gpr[13],
  311. IOMUXC_GPR13_SATA_MASK,
  312. IOMUXC_GPR13_SATA_PHY_8_RXEQ_3P0DB
  313. |IOMUXC_GPR13_SATA_PHY_7_SATA2M
  314. |IOMUXC_GPR13_SATA_SPEED_3G
  315. |(3<<IOMUXC_GPR13_SATA_PHY_6_SHIFT)
  316. |IOMUXC_GPR13_SATA_SATA_PHY_5_SS_DISABLED
  317. |IOMUXC_GPR13_SATA_SATA_PHY_4_ATTEN_9_16
  318. |IOMUXC_GPR13_SATA_PHY_3_TXBOOST_0P00_DB
  319. |IOMUXC_GPR13_SATA_PHY_2_TX_1P104V
  320. |IOMUXC_GPR13_SATA_PHY_1_SLOW);
  321. return 0;
  322. }
  323. #endif
  324. int board_early_init_f(void)
  325. {
  326. setup_iomux_uart();
  327. setup_buttons();
  328. return 0;
  329. }
  330. int board_init(void)
  331. {
  332. /* address of boot parameters */
  333. gd->bd->bi_boot_params = PHYS_SDRAM + 0x100;
  334. #ifdef CONFIG_MXC_SPI
  335. setup_spi();
  336. #endif
  337. setup_i2c(0, CONFIG_SYS_I2C_SPEED, 0x7f, &i2c_pad_info0);
  338. setup_i2c(1, CONFIG_SYS_I2C_SPEED, 0x7f, &i2c_pad_info1);
  339. setup_i2c(2, CONFIG_SYS_I2C_SPEED, 0x7f, &i2c_pad_info2);
  340. #ifdef CONFIG_CMD_SATA
  341. setup_sata();
  342. #endif
  343. return 0;
  344. }
  345. int checkboard(void)
  346. {
  347. puts("Board: MX6Q-Sabre Lite\n");
  348. return 0;
  349. }
  350. struct button_key {
  351. char const *name;
  352. unsigned gpnum;
  353. char ident;
  354. };
  355. static struct button_key const buttons[] = {
  356. {"back", IMX_GPIO_NR(2, 2), 'B'},
  357. {"home", IMX_GPIO_NR(2, 4), 'H'},
  358. {"menu", IMX_GPIO_NR(2, 1), 'M'},
  359. {"search", IMX_GPIO_NR(2, 3), 'S'},
  360. {"volup", IMX_GPIO_NR(7, 13), 'V'},
  361. {"voldown", IMX_GPIO_NR(4, 5), 'v'},
  362. };
  363. /*
  364. * generate a null-terminated string containing the buttons pressed
  365. * returns number of keys pressed
  366. */
  367. static int read_keys(char *buf)
  368. {
  369. int i, numpressed = 0;
  370. for (i = 0; i < ARRAY_SIZE(buttons); i++) {
  371. if (!gpio_get_value(buttons[i].gpnum))
  372. buf[numpressed++] = buttons[i].ident;
  373. }
  374. buf[numpressed] = '\0';
  375. return numpressed;
  376. }
  377. static int do_kbd(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  378. {
  379. char envvalue[ARRAY_SIZE(buttons)+1];
  380. int numpressed = read_keys(envvalue);
  381. setenv("keybd", envvalue);
  382. return numpressed == 0;
  383. }
  384. U_BOOT_CMD(
  385. kbd, 1, 1, do_kbd,
  386. "Tests for keypresses, sets 'keybd' environment variable",
  387. "Returns 0 (true) to shell if key is pressed."
  388. );
  389. #ifdef CONFIG_PREBOOT
  390. static char const kbd_magic_prefix[] = "key_magic";
  391. static char const kbd_command_prefix[] = "key_cmd";
  392. static void preboot_keys(void)
  393. {
  394. int numpressed;
  395. char keypress[ARRAY_SIZE(buttons)+1];
  396. numpressed = read_keys(keypress);
  397. if (numpressed) {
  398. char *kbd_magic_keys = getenv("magic_keys");
  399. char *suffix;
  400. /*
  401. * loop over all magic keys
  402. */
  403. for (suffix = kbd_magic_keys; *suffix; ++suffix) {
  404. char *keys;
  405. char magic[sizeof(kbd_magic_prefix) + 1];
  406. sprintf(magic, "%s%c", kbd_magic_prefix, *suffix);
  407. keys = getenv(magic);
  408. if (keys) {
  409. if (!strcmp(keys, keypress))
  410. break;
  411. }
  412. }
  413. if (*suffix) {
  414. char cmd_name[sizeof(kbd_command_prefix) + 1];
  415. char *cmd;
  416. sprintf(cmd_name, "%s%c", kbd_command_prefix, *suffix);
  417. cmd = getenv(cmd_name);
  418. if (cmd) {
  419. setenv("preboot", cmd);
  420. return;
  421. }
  422. }
  423. }
  424. }
  425. #endif
  426. #ifdef CONFIG_CMD_BMODE
  427. static const struct boot_mode board_boot_modes[] = {
  428. /* 4 bit bus width */
  429. {"mmc0", MAKE_CFGVAL(0x40, 0x30, 0x00, 0x00)},
  430. {"mmc1", MAKE_CFGVAL(0x40, 0x38, 0x00, 0x00)},
  431. {NULL, 0},
  432. };
  433. #endif
  434. int misc_init_r(void)
  435. {
  436. #ifdef CONFIG_PREBOOT
  437. preboot_keys();
  438. #endif
  439. #ifdef CONFIG_CMD_BMODE
  440. add_board_boot_modes(board_boot_modes);
  441. #endif
  442. return 0;
  443. }