mx6qsabrelite.c 14 KB

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