mx6qsabrelite.c 14 KB

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