pl061.c 8.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334
  1. /*
  2. * Arm PrimeCell PL061 General Purpose IO with additional
  3. * Luminary Micro Stellaris bits.
  4. *
  5. * Copyright (c) 2007 CodeSourcery.
  6. * Written by Paul Brook
  7. *
  8. * This code is licensed under the GPL.
  9. */
  10. #include "sysbus.h"
  11. //#define DEBUG_PL061 1
  12. #ifdef DEBUG_PL061
  13. #define DPRINTF(fmt, ...) \
  14. do { printf("pl061: " fmt , ## __VA_ARGS__); } while (0)
  15. #define BADF(fmt, ...) \
  16. do { fprintf(stderr, "pl061: error: " fmt , ## __VA_ARGS__); exit(1);} while (0)
  17. #else
  18. #define DPRINTF(fmt, ...) do {} while(0)
  19. #define BADF(fmt, ...) \
  20. do { fprintf(stderr, "pl061: error: " fmt , ## __VA_ARGS__);} while (0)
  21. #endif
  22. static const uint8_t pl061_id[12] =
  23. { 0x00, 0x00, 0x00, 0x00, 0x61, 0x10, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1 };
  24. static const uint8_t pl061_id_luminary[12] =
  25. { 0x00, 0x00, 0x00, 0x00, 0x61, 0x00, 0x18, 0x01, 0x0d, 0xf0, 0x05, 0xb1 };
  26. typedef struct {
  27. SysBusDevice busdev;
  28. MemoryRegion iomem;
  29. uint32_t locked;
  30. uint32_t data;
  31. uint32_t old_data;
  32. uint32_t dir;
  33. uint32_t isense;
  34. uint32_t ibe;
  35. uint32_t iev;
  36. uint32_t im;
  37. uint32_t istate;
  38. uint32_t afsel;
  39. uint32_t dr2r;
  40. uint32_t dr4r;
  41. uint32_t dr8r;
  42. uint32_t odr;
  43. uint32_t pur;
  44. uint32_t pdr;
  45. uint32_t slr;
  46. uint32_t den;
  47. uint32_t cr;
  48. uint32_t float_high;
  49. uint32_t amsel;
  50. qemu_irq irq;
  51. qemu_irq out[8];
  52. const unsigned char *id;
  53. } pl061_state;
  54. static const VMStateDescription vmstate_pl061 = {
  55. .name = "pl061",
  56. .version_id = 2,
  57. .minimum_version_id = 1,
  58. .fields = (VMStateField[]) {
  59. VMSTATE_UINT32(locked, pl061_state),
  60. VMSTATE_UINT32(data, pl061_state),
  61. VMSTATE_UINT32(old_data, pl061_state),
  62. VMSTATE_UINT32(dir, pl061_state),
  63. VMSTATE_UINT32(isense, pl061_state),
  64. VMSTATE_UINT32(ibe, pl061_state),
  65. VMSTATE_UINT32(iev, pl061_state),
  66. VMSTATE_UINT32(im, pl061_state),
  67. VMSTATE_UINT32(istate, pl061_state),
  68. VMSTATE_UINT32(afsel, pl061_state),
  69. VMSTATE_UINT32(dr2r, pl061_state),
  70. VMSTATE_UINT32(dr4r, pl061_state),
  71. VMSTATE_UINT32(dr8r, pl061_state),
  72. VMSTATE_UINT32(odr, pl061_state),
  73. VMSTATE_UINT32(pur, pl061_state),
  74. VMSTATE_UINT32(pdr, pl061_state),
  75. VMSTATE_UINT32(slr, pl061_state),
  76. VMSTATE_UINT32(den, pl061_state),
  77. VMSTATE_UINT32(cr, pl061_state),
  78. VMSTATE_UINT32(float_high, pl061_state),
  79. VMSTATE_UINT32_V(amsel, pl061_state, 2),
  80. VMSTATE_END_OF_LIST()
  81. }
  82. };
  83. static void pl061_update(pl061_state *s)
  84. {
  85. uint8_t changed;
  86. uint8_t mask;
  87. uint8_t out;
  88. int i;
  89. /* Outputs float high. */
  90. /* FIXME: This is board dependent. */
  91. out = (s->data & s->dir) | ~s->dir;
  92. changed = s->old_data ^ out;
  93. if (!changed)
  94. return;
  95. s->old_data = out;
  96. for (i = 0; i < 8; i++) {
  97. mask = 1 << i;
  98. if (changed & mask) {
  99. DPRINTF("Set output %d = %d\n", i, (out & mask) != 0);
  100. qemu_set_irq(s->out[i], (out & mask) != 0);
  101. }
  102. }
  103. /* FIXME: Implement input interrupts. */
  104. }
  105. static uint64_t pl061_read(void *opaque, target_phys_addr_t offset,
  106. unsigned size)
  107. {
  108. pl061_state *s = (pl061_state *)opaque;
  109. if (offset >= 0xfd0 && offset < 0x1000) {
  110. return s->id[(offset - 0xfd0) >> 2];
  111. }
  112. if (offset < 0x400) {
  113. return s->data & (offset >> 2);
  114. }
  115. switch (offset) {
  116. case 0x400: /* Direction */
  117. return s->dir;
  118. case 0x404: /* Interrupt sense */
  119. return s->isense;
  120. case 0x408: /* Interrupt both edges */
  121. return s->ibe;
  122. case 0x40c: /* Interrupt event */
  123. return s->iev;
  124. case 0x410: /* Interrupt mask */
  125. return s->im;
  126. case 0x414: /* Raw interrupt status */
  127. return s->istate;
  128. case 0x418: /* Masked interrupt status */
  129. return s->istate | s->im;
  130. case 0x420: /* Alternate function select */
  131. return s->afsel;
  132. case 0x500: /* 2mA drive */
  133. return s->dr2r;
  134. case 0x504: /* 4mA drive */
  135. return s->dr4r;
  136. case 0x508: /* 8mA drive */
  137. return s->dr8r;
  138. case 0x50c: /* Open drain */
  139. return s->odr;
  140. case 0x510: /* Pull-up */
  141. return s->pur;
  142. case 0x514: /* Pull-down */
  143. return s->pdr;
  144. case 0x518: /* Slew rate control */
  145. return s->slr;
  146. case 0x51c: /* Digital enable */
  147. return s->den;
  148. case 0x520: /* Lock */
  149. return s->locked;
  150. case 0x524: /* Commit */
  151. return s->cr;
  152. case 0x528: /* Analog mode select */
  153. return s->amsel;
  154. default:
  155. hw_error("pl061_read: Bad offset %x\n", (int)offset);
  156. return 0;
  157. }
  158. }
  159. static void pl061_write(void *opaque, target_phys_addr_t offset,
  160. uint64_t value, unsigned size)
  161. {
  162. pl061_state *s = (pl061_state *)opaque;
  163. uint8_t mask;
  164. if (offset < 0x400) {
  165. mask = (offset >> 2) & s->dir;
  166. s->data = (s->data & ~mask) | (value & mask);
  167. pl061_update(s);
  168. return;
  169. }
  170. switch (offset) {
  171. case 0x400: /* Direction */
  172. s->dir = value & 0xff;
  173. break;
  174. case 0x404: /* Interrupt sense */
  175. s->isense = value & 0xff;
  176. break;
  177. case 0x408: /* Interrupt both edges */
  178. s->ibe = value & 0xff;
  179. break;
  180. case 0x40c: /* Interrupt event */
  181. s->iev = value & 0xff;
  182. break;
  183. case 0x410: /* Interrupt mask */
  184. s->im = value & 0xff;
  185. break;
  186. case 0x41c: /* Interrupt clear */
  187. s->istate &= ~value;
  188. break;
  189. case 0x420: /* Alternate function select */
  190. mask = s->cr;
  191. s->afsel = (s->afsel & ~mask) | (value & mask);
  192. break;
  193. case 0x500: /* 2mA drive */
  194. s->dr2r = value & 0xff;
  195. break;
  196. case 0x504: /* 4mA drive */
  197. s->dr4r = value & 0xff;
  198. break;
  199. case 0x508: /* 8mA drive */
  200. s->dr8r = value & 0xff;
  201. break;
  202. case 0x50c: /* Open drain */
  203. s->odr = value & 0xff;
  204. break;
  205. case 0x510: /* Pull-up */
  206. s->pur = value & 0xff;
  207. break;
  208. case 0x514: /* Pull-down */
  209. s->pdr = value & 0xff;
  210. break;
  211. case 0x518: /* Slew rate control */
  212. s->slr = value & 0xff;
  213. break;
  214. case 0x51c: /* Digital enable */
  215. s->den = value & 0xff;
  216. break;
  217. case 0x520: /* Lock */
  218. s->locked = (value != 0xacce551);
  219. break;
  220. case 0x524: /* Commit */
  221. if (!s->locked)
  222. s->cr = value & 0xff;
  223. break;
  224. case 0x528:
  225. s->amsel = value & 0xff;
  226. break;
  227. default:
  228. hw_error("pl061_write: Bad offset %x\n", (int)offset);
  229. }
  230. pl061_update(s);
  231. }
  232. static void pl061_reset(pl061_state *s)
  233. {
  234. s->locked = 1;
  235. s->cr = 0xff;
  236. }
  237. static void pl061_set_irq(void * opaque, int irq, int level)
  238. {
  239. pl061_state *s = (pl061_state *)opaque;
  240. uint8_t mask;
  241. mask = 1 << irq;
  242. if ((s->dir & mask) == 0) {
  243. s->data &= ~mask;
  244. if (level)
  245. s->data |= mask;
  246. pl061_update(s);
  247. }
  248. }
  249. static const MemoryRegionOps pl061_ops = {
  250. .read = pl061_read,
  251. .write = pl061_write,
  252. .endianness = DEVICE_NATIVE_ENDIAN,
  253. };
  254. static int pl061_init(SysBusDevice *dev, const unsigned char *id)
  255. {
  256. pl061_state *s = FROM_SYSBUS(pl061_state, dev);
  257. s->id = id;
  258. memory_region_init_io(&s->iomem, &pl061_ops, s, "pl061", 0x1000);
  259. sysbus_init_mmio(dev, &s->iomem);
  260. sysbus_init_irq(dev, &s->irq);
  261. qdev_init_gpio_in(&dev->qdev, pl061_set_irq, 8);
  262. qdev_init_gpio_out(&dev->qdev, s->out, 8);
  263. pl061_reset(s);
  264. return 0;
  265. }
  266. static int pl061_init_luminary(SysBusDevice *dev)
  267. {
  268. return pl061_init(dev, pl061_id_luminary);
  269. }
  270. static int pl061_init_arm(SysBusDevice *dev)
  271. {
  272. return pl061_init(dev, pl061_id);
  273. }
  274. static void pl061_class_init(ObjectClass *klass, void *data)
  275. {
  276. DeviceClass *dc = DEVICE_CLASS(klass);
  277. SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
  278. k->init = pl061_init_arm;
  279. dc->vmsd = &vmstate_pl061;
  280. }
  281. static TypeInfo pl061_info = {
  282. .name = "pl061",
  283. .parent = TYPE_SYS_BUS_DEVICE,
  284. .instance_size = sizeof(pl061_state),
  285. .class_init = pl061_class_init,
  286. };
  287. static void pl061_luminary_class_init(ObjectClass *klass, void *data)
  288. {
  289. DeviceClass *dc = DEVICE_CLASS(klass);
  290. SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
  291. k->init = pl061_init_luminary;
  292. dc->vmsd = &vmstate_pl061;
  293. }
  294. static TypeInfo pl061_luminary_info = {
  295. .name = "pl061_luminary",
  296. .parent = TYPE_SYS_BUS_DEVICE,
  297. .instance_size = sizeof(pl061_state),
  298. .class_init = pl061_luminary_class_init,
  299. };
  300. static void pl061_register_types(void)
  301. {
  302. type_register_static(&pl061_info);
  303. type_register_static(&pl061_luminary_info);
  304. }
  305. type_init(pl061_register_types)