alarmProcessingDataOperation.c 8.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340
  1. /*
  2. * arch/arm/mach-orion5x/ts78xx-setup.c
  3. *
  4. * Maintainer: Alexander Clouter <alex@digriz.org.uk>
  5. *
  6. * This file is licensed under the terms of the GNU General Public
  7. * License version 2. This program is licensed "as is" without any
  8. * warranty of any kind, whether express or implied.
  9. */
  10. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  11. #include <linux/kernel.h>
  12. #include <linux/init.h>
  13. #include <linux/sysfs.h>
  14. #include <linux/platform_device.h>
  15. #include <linux/mv643xx_eth.h>
  16. #include <linux/ata_platform.h>
  17. #include <linux/m48t86.h>
  18. #include <linux/mtd/nand.h>
  19. #include <linux/mtd/partitions.h>
  20. #include <linux/timeriomem-rng.h>
  21. #include <asm/mach-types.h>
  22. #include <asm/mach/arch.h>
  23. #include <asm/mach/map.h>
  24. #include <mach/orion5x.h>
  25. #include "common.h"
  26. #include "mpp.h"
  27. #include "ts78xx-fpga.h"
  28. /*****************************************************************************
  29. * TS-78xx Info
  30. ****************************************************************************/
  31. /*
  32. * FPGA - lives where the PCI bus would be at ORION5X_PCI_MEM_PHYS_BASE
  33. */
  34. #define TS78XX_FPGA_REGS_PHYS_BASE 0xe8000000
  35. #define TS78XX_FPGA_REGS_VIRT_BASE IOMEM(0xff900000)
  36. #define TS78XX_FPGA_REGS_SIZE SZ_1M
  37. static struct ts78xx_fpga_data ts78xx_fpga = {
  38. .id = 0,
  39. .state = 1,
  40. /* .supports = ... - populated by ts78xx_fpga_supports() */
  41. };
  42. /*****************************************************************************
  43. * I/O Address Mapping
  44. ****************************************************************************/
  45. static struct map_desc ts78xx_io_desc[] __initdata = {
  46. {
  47. .virtual = (unsigned long)TS78XX_FPGA_REGS_VIRT_BASE,
  48. .pfn = __phys_to_pfn(TS78XX_FPGA_REGS_PHYS_BASE),
  49. .length = TS78XX_FPGA_REGS_SIZE,
  50. .type = MT_DEVICE,
  51. },
  52. };
  53. void __init ts78xx_map_io(void)
  54. {
  55. orion5x_map_io();
  56. iotable_init(ts78xx_io_desc, ARRAY_SIZE(ts78xx_io_desc));
  57. }
  58. /*****************************************************************************
  59. * Ethernet
  60. ****************************************************************************/
  61. static struct mv643xx_eth_platform_data ts78xx_eth_data = {
  62. .phy_addr = MV643XX_ETH_PHY_ADDR(0),
  63. };
  64. /*****************************************************************************
  65. * SATA
  66. ****************************************************************************/
  67. static struct mv_sata_platform_data ts78xx_sata_data = {
  68. .n_ports = 2,
  69. };
  70. /*****************************************************************************
  71. * RTC M48T86 - nicked^Wborrowed from arch/arm/mach-ep93xx/ts72xx.c
  72. ****************************************************************************/
  73. #define TS_RTC_CTRL (TS78XX_FPGA_REGS_VIRT_BASE + 0x808)
  74. #define TS_RTC_DATA (TS78XX_FPGA_REGS_VIRT_BASE + 0x80c)
  75. static unsigned char ts78xx_ts_rtc_readbyte(unsigned long addr)
  76. {
  77. writeb(addr, TS_RTC_CTRL);
  78. return readb(TS_RTC_DATA);
  79. }
  80. static void ts78xx_ts_rtc_writebyte(unsigned char value, unsigned long addr)
  81. {
  82. writeb(addr, TS_RTC_CTRL);
  83. writeb(value, TS_RTC_DATA);
  84. }
  85. static struct m48t86_ops ts78xx_ts_rtc_ops = {
  86. .readbyte = ts78xx_ts_rtc_readbyte,
  87. .writebyte = ts78xx_ts_rtc_writebyte,
  88. };
  89. static struct platform_device ts78xx_ts_rtc_device = {
  90. .name = "rtc-m48t86",
  91. .id = -1,
  92. .dev = {
  93. .platform_data = &ts78xx_ts_rtc_ops,
  94. },
  95. .num_resources = 0,
  96. };
  97. /*
  98. * TS uses some of the user storage space on the RTC chip so see if it is
  99. * present; as it's an optional feature at purchase time and not all boards
  100. * will have it present
  101. *
  102. * I've used the method TS use in their rtc7800.c example for the detection
  103. *
  104. * TODO: track down a guinea pig without an RTC to see if we can work out a
  105. * better RTC detection routine
  106. */
  107. static int ts78xx_ts_rtc_load(void)
  108. {
  109. int rc;
  110. unsigned char tmp_rtc0, tmp_rtc1;
  111. tmp_rtc0 = ts78xx_ts_rtc_readbyte(126);
  112. tmp_rtc1 = ts78xx_ts_rtc_readbyte(127);
  113. ts78xx_ts_rtc_writebyte(0x00, 126);
  114. ts78xx_ts_rtc_writebyte(0x55, 127);
  115. if (ts78xx_ts_rtc_readbyte(127) == 0x55) {
  116. ts78xx_ts_rtc_writebyte(0xaa, 127);
  117. if (ts78xx_ts_rtc_readbyte(127) == 0xaa
  118. && ts78xx_ts_rtc_readbyte(126) == 0x00) {
  119. ts78xx_ts_rtc_writebyte(tmp_rtc0, 126);
  120. ts78xx_ts_rtc_writebyte(tmp_rtc1, 127);
  121. if (ts78xx_fpga.supports.ts_rtc.init == 0) {
  122. rc = platform_device_register(&ts78xx_ts_rtc_device);
  123. if (!rc)
  124. ts78xx_fpga.supports.ts_rtc.init = 1;
  125. } else
  126. rc = platform_device_add(&ts78xx_ts_rtc_device);
  127. if (rc)
  128. pr_info("RTC could not be registered: %d\n",
  129. rc);
  130. return rc;
  131. }
  132. }
  133. pr_info("RTC not found\n");
  134. return -ENODEV;
  135. };
  136. static void ts78xx_ts_rtc_unload(void)
  137. {
  138. platform_device_del(&ts78xx_ts_rtc_device);
  139. }
  140. /*****************************************************************************
  141. * NAND Flash
  142. ****************************************************************************/
  143. #define TS_NAND_CTRL (TS78XX_FPGA_REGS_VIRT_BASE + 0x800) /* VIRT */
  144. #define TS_NAND_DATA (TS78XX_FPGA_REGS_PHYS_BASE + 0x804) /* PHYS */
  145. /*
  146. * hardware specific access to control-lines
  147. *
  148. * ctrl:
  149. * NAND_NCE: bit 0 -> bit 2
  150. * NAND_CLE: bit 1 -> bit 1
  151. * NAND_ALE: bit 2 -> bit 0
  152. */
  153. static void ts78xx_ts_nand_cmd_ctrl(struct mtd_info *mtd, int cmd,
  154. unsigned int ctrl)
  155. {
  156. struct nand_chip *this = mtd->priv;
  157. if (ctrl & NAND_CTRL_CHANGE) {
  158. unsigned char bits;
  159. bits = (ctrl & NAND_NCE) << 2;
  160. bits |= ctrl & NAND_CLE;
  161. bits |= (ctrl & NAND_ALE) >> 2;
  162. writeb((readb(TS_NAND_CTRL) & ~0x7) | bits, TS_NAND_CTRL);
  163. }
  164. if (cmd != NAND_CMD_NONE)
  165. writeb(cmd, this->IO_ADDR_W);
  166. }
  167. static int ts78xx_ts_nand_dev_ready(struct mtd_info *mtd)
  168. {
  169. return readb(TS_NAND_CTRL) & 0x20;
  170. }
  171. static void ts78xx_ts_nand_write_buf(struct mtd_info *mtd,
  172. const uint8_t *buf, int len)
  173. {
  174. struct nand_chip *chip = mtd->priv;
  175. void __iomem *io_base = chip->IO_ADDR_W;
  176. unsigned long off = ((unsigned long)buf & 3);
  177. int sz;
  178. if (off) {
  179. sz = min_t(int, 4 - off, len);
  180. writesb(io_base, buf, sz);
  181. buf += sz;
  182. len -= sz;
  183. }
  184. sz = len >> 2;
  185. if (sz) {
  186. u32 *buf32 = (u32 *)buf;
  187. writesl(io_base, buf32, sz);
  188. buf += sz << 2;
  189. len -= sz << 2;
  190. }
  191. if (len)
  192. writesb(io_base, buf, len);
  193. }
  194. static void ts78xx_ts_nand_read_buf(struct mtd_info *mtd,
  195. uint8_t *buf, int len)
  196. {
  197. struct nand_chip *chip = mtd->priv;
  198. void __iomem *io_base = chip->IO_ADDR_R;
  199. unsigned long off = ((unsigned long)buf & 3);
  200. int sz;
  201. if (off) {
  202. sz = min_t(int, 4 - off, len);
  203. readsb(io_base, buf, sz);
  204. buf += sz;
  205. len -= sz;
  206. }
  207. sz = len >> 2;
  208. if (sz) {
  209. u32 *buf32 = (u32 *)buf;
  210. readsl(io_base, buf32, sz);
  211. buf += sz << 2;
  212. len -= sz << 2;
  213. }
  214. if (len)
  215. readsb(io_base, buf, len);
  216. }
  217. static struct mtd_partition ts78xx_ts_nand_parts[] = {
  218. {
  219. .name = "mbr",
  220. .offset = 0,
  221. .size = SZ_128K,
  222. .mask_flags = MTD_WRITEABLE,
  223. }, {
  224. .name = "kernel",
  225. .offset = MTDPART_OFS_APPEND,
  226. .size = SZ_4M,
  227. }, {
  228. .name = "initrd",
  229. .offset = MTDPART_OFS_APPEND,
  230. .size = SZ_4M,
  231. }, {
  232. .name = "rootfs",
  233. .offset = MTDPART_OFS_APPEND,
  234. .size = MTDPART_SIZ_FULL,
  235. }
  236. };
  237. static struct platform_nand_data ts78xx_ts_nand_data = {
  238. .chip = {
  239. .nr_chips = 1,
  240. .partitions = ts78xx_ts_nand_parts,
  241. .nr_partitions = ARRAY_SIZE(ts78xx_ts_nand_parts),
  242. .chip_delay = 15,
  243. .bbt_options = NAND_BBT_USE_FLASH,
  244. },
  245. .ctrl = {
  246. /*
  247. * The HW ECC offloading functions, used to give about a 9%
  248. * performance increase for 'dd if=/dev/mtdblockX' and 5% for
  249. * nanddump. This all however was changed by git commit
  250. * e6cf5df1838c28bb060ac45b5585e48e71bbc740 so now there is
  251. * no performance advantage to be had so we no longer bother
  252. */
  253. .cmd_ctrl = ts78xx_ts_nand_cmd_ctrl,
  254. .dev_ready = ts78xx_ts_nand_dev_ready,
  255. .write_buf = ts78xx_ts_nand_write_buf,
  256. .read_buf = ts78xx_ts_nand_read_buf,
  257. },
  258. };
  259. static struct resource ts78xx_ts_nand_resources
  260. = DEFINE_RES_MEM(TS_NAND_DATA, 4);
  261. static struct platform_device ts78xx_ts_nand_device = {
  262. .name = "gen_nand",
  263. .id = -1,
  264. .dev = {
  265. .platform_data = &ts78xx_ts_nand_data,
  266. },
  267. .resource = &ts78xx_ts_nand_resources,
  268. .num_resources = 1,
  269. };
  270. static int ts78xx_ts_nand_load(void)
  271. {
  272. int rc;
  273. if (ts78xx_fpga.supports.ts_nand.init == 0) {
  274. rc = platform_device_register(&ts78xx_ts_nand_device);
  275. if (!rc)
  276. ts78xx_fpga.supports.ts_nand.init = 1;
  277. } else
  278. rc = platform_device_add(&ts78xx_ts_nand_device);
  279. if (rc)
  280. pr_info("NAND could not be registered: %d\n", rc);
  281. return rc;
  282. };
  283. static void ts78xx_ts_nand_unload(void)
  284. {
  285. platform_device_del(&ts78xx_ts_nand_device);
  286. }
  287. /*****************************************************************************
  288. * HW RNG
  289. ****************************************************************************/
  290. #define TS_RNG_DATA (TS78XX_FPGA_REGS_PHYS_BASE | 0x044)
  291. static struct resource ts78xx_ts_rng_resource
  292. = DEFINE_RES_MEM(TS_RNG_DATA, 4);
  293. static struct timeriomem_rng_data ts78xx_ts_rng_data = {