liquidLevelOperation.c 9.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379
  1. /*
  2. * Copyright 2012 Freescale Semiconductor, Inc.
  3. * Copyright 2012 Linaro Ltd.
  4. *
  5. * The code contained herein is licensed under the GNU General Public
  6. * License. You may obtain a copy of the GNU General Public License
  7. * Version 2 or later at the following locations:
  8. *
  9. * http://www.opensource.org/licenses/gpl-license.html
  10. * http://www.gnu.org/copyleft/gpl.html
  11. */
  12. #include <linux/clk.h>
  13. #include <linux/clkdev.h>
  14. #include <linux/can/platform/flexcan.h>
  15. #include <linux/delay.h>
  16. #include <linux/err.h>
  17. #include <linux/gpio.h>
  18. #include <linux/init.h>
  19. #include <linux/micrel_phy.h>
  20. #include <linux/mxsfb.h>
  21. #include <linux/of_platform.h>
  22. #include <linux/phy.h>
  23. #include <linux/pinctrl/consumer.h>
  24. #include <asm/mach/arch.h>
  25. #include <asm/mach/time.h>
  26. #include <mach/common.h>
  27. #include <mach/digctl.h>
  28. #include <mach/mxs.h>
  29. static struct fb_videomode mx23evk_video_modes[] = {
  30. {
  31. .name = "Samsung-LMS430HF02",
  32. .refresh = 60,
  33. .xres = 480,
  34. .yres = 272,
  35. .pixclock = 108096, /* picosecond (9.2 MHz) */
  36. .left_margin = 15,
  37. .right_margin = 8,
  38. .upper_margin = 12,
  39. .lower_margin = 4,
  40. .hsync_len = 1,
  41. .vsync_len = 1,
  42. .sync = FB_SYNC_DATA_ENABLE_HIGH_ACT |
  43. FB_SYNC_DOTCLK_FAILING_ACT,
  44. },
  45. };
  46. static struct fb_videomode mx28evk_video_modes[] = {
  47. {
  48. .name = "Seiko-43WVF1G",
  49. .refresh = 60,
  50. .xres = 800,
  51. .yres = 480,
  52. .pixclock = 29851, /* picosecond (33.5 MHz) */
  53. .left_margin = 89,
  54. .right_margin = 164,
  55. .upper_margin = 23,
  56. .lower_margin = 10,
  57. .hsync_len = 10,
  58. .vsync_len = 10,
  59. .sync = FB_SYNC_DATA_ENABLE_HIGH_ACT |
  60. FB_SYNC_DOTCLK_FAILING_ACT,
  61. },
  62. };
  63. static struct fb_videomode m28evk_video_modes[] = {
  64. {
  65. .name = "Ampire AM-800480R2TMQW-T01H",
  66. .refresh = 60,
  67. .xres = 800,
  68. .yres = 480,
  69. .pixclock = 30066, /* picosecond (33.26 MHz) */
  70. .left_margin = 0,
  71. .right_margin = 256,
  72. .upper_margin = 0,
  73. .lower_margin = 45,
  74. .hsync_len = 1,
  75. .vsync_len = 1,
  76. .sync = FB_SYNC_DATA_ENABLE_HIGH_ACT,
  77. },
  78. };
  79. static struct fb_videomode apx4devkit_video_modes[] = {
  80. {
  81. .name = "HannStar PJ70112A",
  82. .refresh = 60,
  83. .xres = 800,
  84. .yres = 480,
  85. .pixclock = 33333, /* picosecond (30.00 MHz) */
  86. .left_margin = 88,
  87. .right_margin = 40,
  88. .upper_margin = 32,
  89. .lower_margin = 13,
  90. .hsync_len = 48,
  91. .vsync_len = 3,
  92. .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT |
  93. FB_SYNC_DATA_ENABLE_HIGH_ACT |
  94. FB_SYNC_DOTCLK_FAILING_ACT,
  95. },
  96. };
  97. static struct fb_videomode apf28dev_video_modes[] = {
  98. {
  99. .name = "LW700",
  100. .refresh = 60,
  101. .xres = 800,
  102. .yres = 480,
  103. .pixclock = 30303, /* picosecond */
  104. .left_margin = 96,
  105. .right_margin = 96, /* at least 3 & 1 */
  106. .upper_margin = 0x14,
  107. .lower_margin = 0x15,
  108. .hsync_len = 64,
  109. .vsync_len = 4,
  110. .sync = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT |
  111. FB_SYNC_DATA_ENABLE_HIGH_ACT |
  112. FB_SYNC_DOTCLK_FAILING_ACT,
  113. },
  114. };
  115. static struct mxsfb_platform_data mxsfb_pdata __initdata;
  116. /*
  117. * MX28EVK_FLEXCAN_SWITCH is shared between both flexcan controllers
  118. */
  119. #define MX28EVK_FLEXCAN_SWITCH MXS_GPIO_NR(2, 13)
  120. static int flexcan0_en, flexcan1_en;
  121. static void mx28evk_flexcan_switch(void)
  122. {
  123. if (flexcan0_en || flexcan1_en)
  124. gpio_set_value(MX28EVK_FLEXCAN_SWITCH, 1);
  125. else
  126. gpio_set_value(MX28EVK_FLEXCAN_SWITCH, 0);
  127. }
  128. static void mx28evk_flexcan0_switch(int enable)
  129. {
  130. flexcan0_en = enable;
  131. mx28evk_flexcan_switch();
  132. }
  133. static void mx28evk_flexcan1_switch(int enable)
  134. {
  135. flexcan1_en = enable;
  136. mx28evk_flexcan_switch();
  137. }
  138. static struct flexcan_platform_data flexcan_pdata[2];
  139. static struct of_dev_auxdata mxs_auxdata_lookup[] __initdata = {
  140. OF_DEV_AUXDATA("fsl,imx23-lcdif", 0x80030000, NULL, &mxsfb_pdata),
  141. OF_DEV_AUXDATA("fsl,imx28-lcdif", 0x80030000, NULL, &mxsfb_pdata),
  142. OF_DEV_AUXDATA("fsl,imx28-flexcan", 0x80032000, NULL, &flexcan_pdata[0]),
  143. OF_DEV_AUXDATA("fsl,imx28-flexcan", 0x80034000, NULL, &flexcan_pdata[1]),
  144. { /* sentinel */ }
  145. };
  146. static void __init imx23_timer_init(void)
  147. {
  148. mx23_clocks_init();
  149. }
  150. static struct sys_timer imx23_timer = {
  151. .init = imx23_timer_init,
  152. };
  153. static void __init imx28_timer_init(void)
  154. {
  155. mx28_clocks_init();
  156. }
  157. static struct sys_timer imx28_timer = {
  158. .init = imx28_timer_init,
  159. };
  160. enum mac_oui {
  161. OUI_FSL,
  162. OUI_DENX,
  163. OUI_CRYSTALFONTZ,
  164. };
  165. static void __init update_fec_mac_prop(enum mac_oui oui)
  166. {
  167. struct device_node *np, *from = NULL;
  168. struct property *newmac;
  169. const u32 *ocotp = mxs_get_ocotp();
  170. u8 *macaddr;
  171. u32 val;
  172. int i;
  173. for (i = 0; i < 2; i++) {
  174. np = of_find_compatible_node(from, NULL, "fsl,imx28-fec");
  175. if (!np)
  176. return;
  177. from = np;
  178. if (of_get_property(np, "local-mac-address", NULL))
  179. continue;
  180. newmac = kzalloc(sizeof(*newmac) + 6, GFP_KERNEL);
  181. if (!newmac)
  182. return;
  183. newmac->value = newmac + 1;
  184. newmac->length = 6;
  185. newmac->name = kstrdup("local-mac-address", GFP_KERNEL);
  186. if (!newmac->name) {
  187. kfree(newmac);
  188. return;
  189. }
  190. /*
  191. * OCOTP only stores the last 4 octets for each mac address,
  192. * so hard-code OUI here.
  193. */
  194. macaddr = newmac->value;
  195. switch (oui) {
  196. case OUI_FSL:
  197. macaddr[0] = 0x00;
  198. macaddr[1] = 0x04;
  199. macaddr[2] = 0x9f;
  200. break;
  201. case OUI_DENX:
  202. macaddr[0] = 0xc0;
  203. macaddr[1] = 0xe5;
  204. macaddr[2] = 0x4e;
  205. break;
  206. case OUI_CRYSTALFONTZ:
  207. macaddr[0] = 0x58;
  208. macaddr[1] = 0xb9;
  209. macaddr[2] = 0xe1;
  210. break;
  211. }
  212. val = ocotp[i];
  213. macaddr[3] = (val >> 16) & 0xff;
  214. macaddr[4] = (val >> 8) & 0xff;
  215. macaddr[5] = (val >> 0) & 0xff;
  216. of_update_property(np, newmac);
  217. }
  218. }
  219. static void __init imx23_evk_init(void)
  220. {
  221. mxsfb_pdata.mode_list = mx23evk_video_modes;
  222. mxsfb_pdata.mode_count = ARRAY_SIZE(mx23evk_video_modes);
  223. mxsfb_pdata.default_bpp = 32;
  224. mxsfb_pdata.ld_intf_width = STMLCDIF_24BIT;
  225. }
  226. static inline void enable_clk_enet_out(void)
  227. {
  228. struct clk *clk = clk_get_sys("enet_out", NULL);
  229. if (!IS_ERR(clk))
  230. clk_prepare_enable(clk);
  231. }
  232. static void __init imx28_evk_init(void)
  233. {
  234. enable_clk_enet_out();
  235. update_fec_mac_prop(OUI_FSL);
  236. mxsfb_pdata.mode_list = mx28evk_video_modes;
  237. mxsfb_pdata.mode_count = ARRAY_SIZE(mx28evk_video_modes);
  238. mxsfb_pdata.default_bpp = 32;
  239. mxsfb_pdata.ld_intf_width = STMLCDIF_24BIT;
  240. mxs_saif_clkmux_select(MXS_DIGCTL_SAIF_CLKMUX_EXTMSTR0);
  241. }
  242. static void __init imx28_evk_post_init(void)
  243. {
  244. if (!gpio_request_one(MX28EVK_FLEXCAN_SWITCH, GPIOF_DIR_OUT,
  245. "flexcan-switch")) {
  246. flexcan_pdata[0].transceiver_switch = mx28evk_flexcan0_switch;
  247. flexcan_pdata[1].transceiver_switch = mx28evk_flexcan1_switch;
  248. }
  249. }
  250. static void __init m28evk_init(void)
  251. {
  252. mxsfb_pdata.mode_list = m28evk_video_modes;
  253. mxsfb_pdata.mode_count = ARRAY_SIZE(m28evk_video_modes);
  254. mxsfb_pdata.default_bpp = 16;
  255. mxsfb_pdata.ld_intf_width = STMLCDIF_18BIT;
  256. }
  257. static void __init sc_sps1_init(void)
  258. {
  259. enable_clk_enet_out();
  260. }
  261. static int apx4devkit_phy_fixup(struct phy_device *phy)
  262. {
  263. phy->dev_flags |= MICREL_PHY_50MHZ_CLK;
  264. return 0;
  265. }
  266. static void __init apx4devkit_init(void)
  267. {
  268. enable_clk_enet_out();
  269. if (IS_BUILTIN(CONFIG_PHYLIB))
  270. phy_register_fixup_for_uid(PHY_ID_KSZ8051, MICREL_PHY_ID_MASK,
  271. apx4devkit_phy_fixup);
  272. mxsfb_pdata.mode_list = apx4devkit_video_modes;
  273. mxsfb_pdata.mode_count = ARRAY_SIZE(apx4devkit_video_modes);
  274. mxsfb_pdata.default_bpp = 32;
  275. mxsfb_pdata.ld_intf_width = STMLCDIF_24BIT;
  276. }
  277. #define ENET0_MDC__GPIO_4_0 MXS_GPIO_NR(4, 0)
  278. #define ENET0_MDIO__GPIO_4_1 MXS_GPIO_NR(4, 1)
  279. #define ENET0_RX_EN__GPIO_4_2 MXS_GPIO_NR(4, 2)
  280. #define ENET0_RXD0__GPIO_4_3 MXS_GPIO_NR(4, 3)
  281. #define ENET0_RXD1__GPIO_4_4 MXS_GPIO_NR(4, 4)
  282. #define ENET0_TX_EN__GPIO_4_6 MXS_GPIO_NR(4, 6)
  283. #define ENET0_TXD0__GPIO_4_7 MXS_GPIO_NR(4, 7)
  284. #define ENET0_TXD1__GPIO_4_8 MXS_GPIO_NR(4, 8)
  285. #define ENET_CLK__GPIO_4_16 MXS_GPIO_NR(4, 16)
  286. #define TX28_FEC_PHY_POWER MXS_GPIO_NR(3, 29)
  287. #define TX28_FEC_PHY_RESET MXS_GPIO_NR(4, 13)
  288. #define TX28_FEC_nINT MXS_GPIO_NR(4, 5)
  289. static const struct gpio tx28_gpios[] __initconst = {
  290. { ENET0_MDC__GPIO_4_0, GPIOF_OUT_INIT_LOW, "GPIO_4_0" },
  291. { ENET0_MDIO__GPIO_4_1, GPIOF_OUT_INIT_LOW, "GPIO_4_1" },
  292. { ENET0_RX_EN__GPIO_4_2, GPIOF_OUT_INIT_LOW, "GPIO_4_2" },
  293. { ENET0_RXD0__GPIO_4_3, GPIOF_OUT_INIT_LOW, "GPIO_4_3" },
  294. { ENET0_RXD1__GPIO_4_4, GPIOF_OUT_INIT_LOW, "GPIO_4_4" },
  295. { ENET0_TX_EN__GPIO_4_6, GPIOF_OUT_INIT_LOW, "GPIO_4_6" },
  296. { ENET0_TXD0__GPIO_4_7, GPIOF_OUT_INIT_LOW, "GPIO_4_7" },
  297. { ENET0_TXD1__GPIO_4_8, GPIOF_OUT_INIT_LOW, "GPIO_4_8" },
  298. { ENET_CLK__GPIO_4_16, GPIOF_OUT_INIT_LOW, "GPIO_4_16" },
  299. { TX28_FEC_PHY_POWER, GPIOF_OUT_INIT_LOW, "fec-phy-power" },
  300. { TX28_FEC_PHY_RESET, GPIOF_OUT_INIT_LOW, "fec-phy-reset" },
  301. { TX28_FEC_nINT, GPIOF_DIR_IN, "fec-int" },
  302. };
  303. static void __init tx28_post_init(void)
  304. {
  305. struct device_node *np;
  306. struct platform_device *pdev;
  307. struct pinctrl *pctl;
  308. int ret;
  309. enable_clk_enet_out();
  310. np = of_find_compatible_node(NULL, NULL, "fsl,imx28-fec");
  311. pdev = of_find_device_by_node(np);
  312. if (!pdev) {
  313. pr_err("%s: failed to find fec device\n", __func__);
  314. return;
  315. }
  316. pctl = pinctrl_get_select(&pdev->dev, "gpio_mode");
  317. if (IS_ERR(pctl)) {
  318. pr_err("%s: failed to get pinctrl state\n", __func__);
  319. return;
  320. }
  321. ret = gpio_request_array(tx28_gpios, ARRAY_SIZE(tx28_gpios));
  322. if (ret) {
  323. pr_err("%s: failed to request gpios: %d\n", __func__, ret);
  324. return;
  325. }
  326. /* Power up fec phy */
  327. gpio_set_value(TX28_FEC_PHY_POWER, 1);
  328. msleep(26); /* 25ms according to data sheet */
  329. /* Mode strap pins */