mx6qsabrelite.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514
  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 const 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 const 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 const 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 const 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 const 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 const 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 const 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(IMX_GPIO_NR(3, 23), 0);
  180. gpio_direction_output(IMX_GPIO_NR(6, 30), 1);
  181. gpio_direction_output(IMX_GPIO_NR(6, 25), 1);
  182. gpio_direction_output(IMX_GPIO_NR(6, 27), 1);
  183. gpio_direction_output(IMX_GPIO_NR(6, 28), 1);
  184. gpio_direction_output(IMX_GPIO_NR(6, 29), 1);
  185. imx_iomux_v3_setup_multiple_pads(enet_pads1, ARRAY_SIZE(enet_pads1));
  186. gpio_direction_output(IMX_GPIO_NR(6, 24), 1);
  187. /* Need delay 10ms according to KSZ9021 spec */
  188. udelay(1000 * 10);
  189. gpio_set_value(IMX_GPIO_NR(3, 23), 1);
  190. imx_iomux_v3_setup_multiple_pads(enet_pads2, ARRAY_SIZE(enet_pads2));
  191. }
  192. iomux_v3_cfg_t const 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},
  214. {USDHC4_BASE_ADDR},
  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(IMX_GPIO_NR(7, 0));
  222. ret = !gpio_get_value(IMX_GPIO_NR(7, 0));
  223. } else {
  224. gpio_direction_input(IMX_GPIO_NR(2, 6));
  225. ret = !gpio_get_value(IMX_GPIO_NR(2, 6));
  226. }
  227. return ret;
  228. }
  229. int board_mmc_init(bd_t *bis)
  230. {
  231. s32 status = 0;
  232. u32 index = 0;
  233. usdhc_cfg[0].sdhc_clk = mxc_get_clock(MXC_ESDHC3_CLK);
  234. usdhc_cfg[1].sdhc_clk = mxc_get_clock(MXC_ESDHC4_CLK);
  235. for (index = 0; index < CONFIG_SYS_FSL_USDHC_NUM; ++index) {
  236. switch (index) {
  237. case 0:
  238. imx_iomux_v3_setup_multiple_pads(
  239. usdhc3_pads, ARRAY_SIZE(usdhc3_pads));
  240. break;
  241. case 1:
  242. imx_iomux_v3_setup_multiple_pads(
  243. usdhc4_pads, ARRAY_SIZE(usdhc4_pads));
  244. break;
  245. default:
  246. printf("Warning: you configured more USDHC controllers"
  247. "(%d) then supported by the board (%d)\n",
  248. index + 1, CONFIG_SYS_FSL_USDHC_NUM);
  249. return status;
  250. }
  251. status |= fsl_esdhc_initialize(bis, &usdhc_cfg[index]);
  252. }
  253. return status;
  254. }
  255. #endif
  256. u32 get_board_rev(void)
  257. {
  258. return 0x63000 ;
  259. }
  260. #ifdef CONFIG_MXC_SPI
  261. iomux_v3_cfg_t const ecspi1_pads[] = {
  262. /* SS1 */
  263. MX6Q_PAD_EIM_D19__GPIO_3_19 | MUX_PAD_CTRL(SPI_PAD_CTRL),
  264. MX6Q_PAD_EIM_D17__ECSPI1_MISO | MUX_PAD_CTRL(SPI_PAD_CTRL),
  265. MX6Q_PAD_EIM_D18__ECSPI1_MOSI | MUX_PAD_CTRL(SPI_PAD_CTRL),
  266. MX6Q_PAD_EIM_D16__ECSPI1_SCLK | MUX_PAD_CTRL(SPI_PAD_CTRL),
  267. };
  268. void setup_spi(void)
  269. {
  270. gpio_direction_output(CONFIG_SF_DEFAULT_CS, 1);
  271. imx_iomux_v3_setup_multiple_pads(ecspi1_pads,
  272. ARRAY_SIZE(ecspi1_pads));
  273. }
  274. #endif
  275. int board_phy_config(struct phy_device *phydev)
  276. {
  277. /* min rx data delay */
  278. ksz9021_phy_extended_write(phydev,
  279. MII_KSZ9021_EXT_RGMII_RX_DATA_SKEW, 0x0);
  280. /* min tx data delay */
  281. ksz9021_phy_extended_write(phydev,
  282. MII_KSZ9021_EXT_RGMII_TX_DATA_SKEW, 0x0);
  283. /* max rx/tx clock delay, min rx/tx control */
  284. ksz9021_phy_extended_write(phydev,
  285. MII_KSZ9021_EXT_RGMII_CLOCK_SKEW, 0xf0f0);
  286. if (phydev->drv->config)
  287. phydev->drv->config(phydev);
  288. return 0;
  289. }
  290. int board_eth_init(bd_t *bis)
  291. {
  292. int ret;
  293. setup_iomux_enet();
  294. ret = cpu_eth_init(bis);
  295. if (ret)
  296. printf("FEC MXC: %s:failed\n", __func__);
  297. return 0;
  298. }
  299. static void setup_buttons(void)
  300. {
  301. imx_iomux_v3_setup_multiple_pads(button_pads,
  302. ARRAY_SIZE(button_pads));
  303. }
  304. #ifdef CONFIG_CMD_SATA
  305. int setup_sata(void)
  306. {
  307. struct iomuxc_base_regs *const iomuxc_regs
  308. = (struct iomuxc_base_regs *) IOMUXC_BASE_ADDR;
  309. int ret = enable_sata_clock();
  310. if (ret)
  311. return ret;
  312. clrsetbits_le32(&iomuxc_regs->gpr[13],
  313. IOMUXC_GPR13_SATA_MASK,
  314. IOMUXC_GPR13_SATA_PHY_8_RXEQ_3P0DB
  315. |IOMUXC_GPR13_SATA_PHY_7_SATA2M
  316. |IOMUXC_GPR13_SATA_SPEED_3G
  317. |(3<<IOMUXC_GPR13_SATA_PHY_6_SHIFT)
  318. |IOMUXC_GPR13_SATA_SATA_PHY_5_SS_DISABLED
  319. |IOMUXC_GPR13_SATA_SATA_PHY_4_ATTEN_9_16
  320. |IOMUXC_GPR13_SATA_PHY_3_TXBOOST_0P00_DB
  321. |IOMUXC_GPR13_SATA_PHY_2_TX_1P104V
  322. |IOMUXC_GPR13_SATA_PHY_1_SLOW);
  323. return 0;
  324. }
  325. #endif
  326. int board_early_init_f(void)
  327. {
  328. setup_iomux_uart();
  329. setup_buttons();
  330. return 0;
  331. }
  332. int board_init(void)
  333. {
  334. /* address of boot parameters */
  335. gd->bd->bi_boot_params = PHYS_SDRAM + 0x100;
  336. #ifdef CONFIG_MXC_SPI
  337. setup_spi();
  338. #endif
  339. setup_i2c(0, CONFIG_SYS_I2C_SPEED, 0x7f, &i2c_pad_info0);
  340. setup_i2c(1, CONFIG_SYS_I2C_SPEED, 0x7f, &i2c_pad_info1);
  341. setup_i2c(2, CONFIG_SYS_I2C_SPEED, 0x7f, &i2c_pad_info2);
  342. #ifdef CONFIG_CMD_SATA
  343. setup_sata();
  344. #endif
  345. return 0;
  346. }
  347. int checkboard(void)
  348. {
  349. puts("Board: MX6Q-Sabre Lite\n");
  350. return 0;
  351. }
  352. struct button_key {
  353. char const *name;
  354. unsigned gpnum;
  355. char ident;
  356. };
  357. static struct button_key const buttons[] = {
  358. {"back", IMX_GPIO_NR(2, 2), 'B'},
  359. {"home", IMX_GPIO_NR(2, 4), 'H'},
  360. {"menu", IMX_GPIO_NR(2, 1), 'M'},
  361. {"search", IMX_GPIO_NR(2, 3), 'S'},
  362. {"volup", IMX_GPIO_NR(7, 13), 'V'},
  363. {"voldown", IMX_GPIO_NR(4, 5), 'v'},
  364. };
  365. /*
  366. * generate a null-terminated string containing the buttons pressed
  367. * returns number of keys pressed
  368. */
  369. static int read_keys(char *buf)
  370. {
  371. int i, numpressed = 0;
  372. for (i = 0; i < ARRAY_SIZE(buttons); i++) {
  373. if (!gpio_get_value(buttons[i].gpnum))
  374. buf[numpressed++] = buttons[i].ident;
  375. }
  376. buf[numpressed] = '\0';
  377. return numpressed;
  378. }
  379. static int do_kbd(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  380. {
  381. char envvalue[ARRAY_SIZE(buttons)+1];
  382. int numpressed = read_keys(envvalue);
  383. setenv("keybd", envvalue);
  384. return numpressed == 0;
  385. }
  386. U_BOOT_CMD(
  387. kbd, 1, 1, do_kbd,
  388. "Tests for keypresses, sets 'keybd' environment variable",
  389. "Returns 0 (true) to shell if key is pressed."
  390. );
  391. #ifdef CONFIG_PREBOOT
  392. static char const kbd_magic_prefix[] = "key_magic";
  393. static char const kbd_command_prefix[] = "key_cmd";
  394. static void preboot_keys(void)
  395. {
  396. int numpressed;
  397. char keypress[ARRAY_SIZE(buttons)+1];
  398. numpressed = read_keys(keypress);
  399. if (numpressed) {
  400. char *kbd_magic_keys = getenv("magic_keys");
  401. char *suffix;
  402. /*
  403. * loop over all magic keys
  404. */
  405. for (suffix = kbd_magic_keys; *suffix; ++suffix) {
  406. char *keys;
  407. char magic[sizeof(kbd_magic_prefix) + 1];
  408. sprintf(magic, "%s%c", kbd_magic_prefix, *suffix);
  409. keys = getenv(magic);
  410. if (keys) {
  411. if (!strcmp(keys, keypress))
  412. break;
  413. }
  414. }
  415. if (*suffix) {
  416. char cmd_name[sizeof(kbd_command_prefix) + 1];
  417. char *cmd;
  418. sprintf(cmd_name, "%s%c", kbd_command_prefix, *suffix);
  419. cmd = getenv(cmd_name);
  420. if (cmd) {
  421. setenv("preboot", cmd);
  422. return;
  423. }
  424. }
  425. }
  426. }
  427. #endif
  428. #ifdef CONFIG_CMD_BMODE
  429. static const struct boot_mode board_boot_modes[] = {
  430. /* 4 bit bus width */
  431. {"mmc0", MAKE_CFGVAL(0x40, 0x30, 0x00, 0x00)},
  432. {"mmc1", MAKE_CFGVAL(0x40, 0x38, 0x00, 0x00)},
  433. {NULL, 0},
  434. };
  435. #endif
  436. int misc_init_r(void)
  437. {
  438. #ifdef CONFIG_PREBOOT
  439. preboot_keys();
  440. #endif
  441. #ifdef CONFIG_CMD_BMODE
  442. add_board_boot_modes(board_boot_modes);
  443. #endif
  444. return 0;
  445. }