omap_gpio.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811
  1. /*
  2. * TI OMAP processors GPIO emulation.
  3. *
  4. * Copyright (C) 2006-2008 Andrzej Zaborowski <balrog@zabor.org>
  5. * Copyright (C) 2007-2009 Nokia Corporation
  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 or
  10. * (at your option) version 3 of the License.
  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 along
  18. * with this program; if not, see <http://www.gnu.org/licenses/>.
  19. */
  20. #include "qemu/osdep.h"
  21. #include "hw/irq.h"
  22. #include "hw/qdev-properties.h"
  23. #include "hw/arm/omap.h"
  24. #include "hw/sysbus.h"
  25. #include "qemu/error-report.h"
  26. #include "qemu/module.h"
  27. #include "qapi/error.h"
  28. struct omap_gpio_s {
  29. qemu_irq irq;
  30. qemu_irq handler[16];
  31. uint16_t inputs;
  32. uint16_t outputs;
  33. uint16_t dir;
  34. uint16_t edge;
  35. uint16_t mask;
  36. uint16_t ints;
  37. uint16_t pins;
  38. };
  39. struct omap_gpif_s {
  40. SysBusDevice parent_obj;
  41. MemoryRegion iomem;
  42. int mpu_model;
  43. void *clk;
  44. struct omap_gpio_s omap1;
  45. };
  46. /* General-Purpose I/O of OMAP1 */
  47. static void omap_gpio_set(void *opaque, int line, int level)
  48. {
  49. struct omap_gpio_s *s = &((struct omap_gpif_s *) opaque)->omap1;
  50. uint16_t prev = s->inputs;
  51. if (level)
  52. s->inputs |= 1 << line;
  53. else
  54. s->inputs &= ~(1 << line);
  55. if (((s->edge & s->inputs & ~prev) | (~s->edge & ~s->inputs & prev)) &
  56. (1 << line) & s->dir & ~s->mask) {
  57. s->ints |= 1 << line;
  58. qemu_irq_raise(s->irq);
  59. }
  60. }
  61. static uint64_t omap_gpio_read(void *opaque, hwaddr addr,
  62. unsigned size)
  63. {
  64. struct omap_gpio_s *s = (struct omap_gpio_s *) opaque;
  65. int offset = addr & OMAP_MPUI_REG_MASK;
  66. if (size != 2) {
  67. return omap_badwidth_read16(opaque, addr);
  68. }
  69. switch (offset) {
  70. case 0x00: /* DATA_INPUT */
  71. return s->inputs & s->pins;
  72. case 0x04: /* DATA_OUTPUT */
  73. return s->outputs;
  74. case 0x08: /* DIRECTION_CONTROL */
  75. return s->dir;
  76. case 0x0c: /* INTERRUPT_CONTROL */
  77. return s->edge;
  78. case 0x10: /* INTERRUPT_MASK */
  79. return s->mask;
  80. case 0x14: /* INTERRUPT_STATUS */
  81. return s->ints;
  82. case 0x18: /* PIN_CONTROL (not in OMAP310) */
  83. OMAP_BAD_REG(addr);
  84. return s->pins;
  85. }
  86. OMAP_BAD_REG(addr);
  87. return 0;
  88. }
  89. static void omap_gpio_write(void *opaque, hwaddr addr,
  90. uint64_t value, unsigned size)
  91. {
  92. struct omap_gpio_s *s = (struct omap_gpio_s *) opaque;
  93. int offset = addr & OMAP_MPUI_REG_MASK;
  94. uint16_t diff;
  95. int ln;
  96. if (size != 2) {
  97. omap_badwidth_write16(opaque, addr, value);
  98. return;
  99. }
  100. switch (offset) {
  101. case 0x00: /* DATA_INPUT */
  102. OMAP_RO_REG(addr);
  103. return;
  104. case 0x04: /* DATA_OUTPUT */
  105. diff = (s->outputs ^ value) & ~s->dir;
  106. s->outputs = value;
  107. while ((ln = ctz32(diff)) != 32) {
  108. if (s->handler[ln])
  109. qemu_set_irq(s->handler[ln], (value >> ln) & 1);
  110. diff &= ~(1 << ln);
  111. }
  112. break;
  113. case 0x08: /* DIRECTION_CONTROL */
  114. diff = s->outputs & (s->dir ^ value);
  115. s->dir = value;
  116. value = s->outputs & ~s->dir;
  117. while ((ln = ctz32(diff)) != 32) {
  118. if (s->handler[ln])
  119. qemu_set_irq(s->handler[ln], (value >> ln) & 1);
  120. diff &= ~(1 << ln);
  121. }
  122. break;
  123. case 0x0c: /* INTERRUPT_CONTROL */
  124. s->edge = value;
  125. break;
  126. case 0x10: /* INTERRUPT_MASK */
  127. s->mask = value;
  128. break;
  129. case 0x14: /* INTERRUPT_STATUS */
  130. s->ints &= ~value;
  131. if (!s->ints)
  132. qemu_irq_lower(s->irq);
  133. break;
  134. case 0x18: /* PIN_CONTROL (not in OMAP310 TRM) */
  135. OMAP_BAD_REG(addr);
  136. s->pins = value;
  137. break;
  138. default:
  139. OMAP_BAD_REG(addr);
  140. return;
  141. }
  142. }
  143. /* *Some* sources say the memory region is 32-bit. */
  144. static const MemoryRegionOps omap_gpio_ops = {
  145. .read = omap_gpio_read,
  146. .write = omap_gpio_write,
  147. .endianness = DEVICE_NATIVE_ENDIAN,
  148. };
  149. static void omap_gpio_reset(struct omap_gpio_s *s)
  150. {
  151. s->inputs = 0;
  152. s->outputs = ~0;
  153. s->dir = ~0;
  154. s->edge = ~0;
  155. s->mask = ~0;
  156. s->ints = 0;
  157. s->pins = ~0;
  158. }
  159. struct omap2_gpio_s {
  160. qemu_irq irq[2];
  161. qemu_irq wkup;
  162. qemu_irq *handler;
  163. MemoryRegion iomem;
  164. uint8_t revision;
  165. uint8_t config[2];
  166. uint32_t inputs;
  167. uint32_t outputs;
  168. uint32_t dir;
  169. uint32_t level[2];
  170. uint32_t edge[2];
  171. uint32_t mask[2];
  172. uint32_t wumask;
  173. uint32_t ints[2];
  174. uint32_t debounce;
  175. uint8_t delay;
  176. };
  177. struct omap2_gpif_s {
  178. SysBusDevice parent_obj;
  179. MemoryRegion iomem;
  180. int mpu_model;
  181. void *iclk;
  182. void *fclk[6];
  183. int modulecount;
  184. struct omap2_gpio_s *modules;
  185. qemu_irq *handler;
  186. int autoidle;
  187. int gpo;
  188. };
  189. /* General-Purpose Interface of OMAP2/3 */
  190. static inline void omap2_gpio_module_int_update(struct omap2_gpio_s *s,
  191. int line)
  192. {
  193. qemu_set_irq(s->irq[line], s->ints[line] & s->mask[line]);
  194. }
  195. static void omap2_gpio_module_wake(struct omap2_gpio_s *s, int line)
  196. {
  197. if (!(s->config[0] & (1 << 2))) /* ENAWAKEUP */
  198. return;
  199. if (!(s->config[0] & (3 << 3))) /* Force Idle */
  200. return;
  201. if (!(s->wumask & (1 << line)))
  202. return;
  203. qemu_irq_raise(s->wkup);
  204. }
  205. static inline void omap2_gpio_module_out_update(struct omap2_gpio_s *s,
  206. uint32_t diff)
  207. {
  208. int ln;
  209. s->outputs ^= diff;
  210. diff &= ~s->dir;
  211. while ((ln = ctz32(diff)) != 32) {
  212. qemu_set_irq(s->handler[ln], (s->outputs >> ln) & 1);
  213. diff &= ~(1 << ln);
  214. }
  215. }
  216. static void omap2_gpio_module_level_update(struct omap2_gpio_s *s, int line)
  217. {
  218. s->ints[line] |= s->dir &
  219. ((s->inputs & s->level[1]) | (~s->inputs & s->level[0]));
  220. omap2_gpio_module_int_update(s, line);
  221. }
  222. static inline void omap2_gpio_module_int(struct omap2_gpio_s *s, int line)
  223. {
  224. s->ints[0] |= 1 << line;
  225. omap2_gpio_module_int_update(s, 0);
  226. s->ints[1] |= 1 << line;
  227. omap2_gpio_module_int_update(s, 1);
  228. omap2_gpio_module_wake(s, line);
  229. }
  230. static void omap2_gpio_set(void *opaque, int line, int level)
  231. {
  232. struct omap2_gpif_s *p = opaque;
  233. struct omap2_gpio_s *s = &p->modules[line >> 5];
  234. line &= 31;
  235. if (level) {
  236. if (s->dir & (1 << line) & ((~s->inputs & s->edge[0]) | s->level[1]))
  237. omap2_gpio_module_int(s, line);
  238. s->inputs |= 1 << line;
  239. } else {
  240. if (s->dir & (1 << line) & ((s->inputs & s->edge[1]) | s->level[0]))
  241. omap2_gpio_module_int(s, line);
  242. s->inputs &= ~(1 << line);
  243. }
  244. }
  245. static void omap2_gpio_module_reset(struct omap2_gpio_s *s)
  246. {
  247. s->config[0] = 0;
  248. s->config[1] = 2;
  249. s->ints[0] = 0;
  250. s->ints[1] = 0;
  251. s->mask[0] = 0;
  252. s->mask[1] = 0;
  253. s->wumask = 0;
  254. s->dir = ~0;
  255. s->level[0] = 0;
  256. s->level[1] = 0;
  257. s->edge[0] = 0;
  258. s->edge[1] = 0;
  259. s->debounce = 0;
  260. s->delay = 0;
  261. }
  262. static uint32_t omap2_gpio_module_read(void *opaque, hwaddr addr)
  263. {
  264. struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
  265. switch (addr) {
  266. case 0x00: /* GPIO_REVISION */
  267. return s->revision;
  268. case 0x10: /* GPIO_SYSCONFIG */
  269. return s->config[0];
  270. case 0x14: /* GPIO_SYSSTATUS */
  271. return 0x01;
  272. case 0x18: /* GPIO_IRQSTATUS1 */
  273. return s->ints[0];
  274. case 0x1c: /* GPIO_IRQENABLE1 */
  275. case 0x60: /* GPIO_CLEARIRQENABLE1 */
  276. case 0x64: /* GPIO_SETIRQENABLE1 */
  277. return s->mask[0];
  278. case 0x20: /* GPIO_WAKEUPENABLE */
  279. case 0x80: /* GPIO_CLEARWKUENA */
  280. case 0x84: /* GPIO_SETWKUENA */
  281. return s->wumask;
  282. case 0x28: /* GPIO_IRQSTATUS2 */
  283. return s->ints[1];
  284. case 0x2c: /* GPIO_IRQENABLE2 */
  285. case 0x70: /* GPIO_CLEARIRQENABLE2 */
  286. case 0x74: /* GPIO_SETIREQNEABLE2 */
  287. return s->mask[1];
  288. case 0x30: /* GPIO_CTRL */
  289. return s->config[1];
  290. case 0x34: /* GPIO_OE */
  291. return s->dir;
  292. case 0x38: /* GPIO_DATAIN */
  293. return s->inputs;
  294. case 0x3c: /* GPIO_DATAOUT */
  295. case 0x90: /* GPIO_CLEARDATAOUT */
  296. case 0x94: /* GPIO_SETDATAOUT */
  297. return s->outputs;
  298. case 0x40: /* GPIO_LEVELDETECT0 */
  299. return s->level[0];
  300. case 0x44: /* GPIO_LEVELDETECT1 */
  301. return s->level[1];
  302. case 0x48: /* GPIO_RISINGDETECT */
  303. return s->edge[0];
  304. case 0x4c: /* GPIO_FALLINGDETECT */
  305. return s->edge[1];
  306. case 0x50: /* GPIO_DEBOUNCENABLE */
  307. return s->debounce;
  308. case 0x54: /* GPIO_DEBOUNCINGTIME */
  309. return s->delay;
  310. }
  311. OMAP_BAD_REG(addr);
  312. return 0;
  313. }
  314. static void omap2_gpio_module_write(void *opaque, hwaddr addr,
  315. uint32_t value)
  316. {
  317. struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
  318. uint32_t diff;
  319. int ln;
  320. switch (addr) {
  321. case 0x00: /* GPIO_REVISION */
  322. case 0x14: /* GPIO_SYSSTATUS */
  323. case 0x38: /* GPIO_DATAIN */
  324. OMAP_RO_REG(addr);
  325. break;
  326. case 0x10: /* GPIO_SYSCONFIG */
  327. if (((value >> 3) & 3) == 3)
  328. fprintf(stderr, "%s: bad IDLEMODE value\n", __func__);
  329. if (value & 2)
  330. omap2_gpio_module_reset(s);
  331. s->config[0] = value & 0x1d;
  332. break;
  333. case 0x18: /* GPIO_IRQSTATUS1 */
  334. if (s->ints[0] & value) {
  335. s->ints[0] &= ~value;
  336. omap2_gpio_module_level_update(s, 0);
  337. }
  338. break;
  339. case 0x1c: /* GPIO_IRQENABLE1 */
  340. s->mask[0] = value;
  341. omap2_gpio_module_int_update(s, 0);
  342. break;
  343. case 0x20: /* GPIO_WAKEUPENABLE */
  344. s->wumask = value;
  345. break;
  346. case 0x28: /* GPIO_IRQSTATUS2 */
  347. if (s->ints[1] & value) {
  348. s->ints[1] &= ~value;
  349. omap2_gpio_module_level_update(s, 1);
  350. }
  351. break;
  352. case 0x2c: /* GPIO_IRQENABLE2 */
  353. s->mask[1] = value;
  354. omap2_gpio_module_int_update(s, 1);
  355. break;
  356. case 0x30: /* GPIO_CTRL */
  357. s->config[1] = value & 7;
  358. break;
  359. case 0x34: /* GPIO_OE */
  360. diff = s->outputs & (s->dir ^ value);
  361. s->dir = value;
  362. value = s->outputs & ~s->dir;
  363. while ((ln = ctz32(diff)) != 32) {
  364. diff &= ~(1 << ln);
  365. qemu_set_irq(s->handler[ln], (value >> ln) & 1);
  366. }
  367. omap2_gpio_module_level_update(s, 0);
  368. omap2_gpio_module_level_update(s, 1);
  369. break;
  370. case 0x3c: /* GPIO_DATAOUT */
  371. omap2_gpio_module_out_update(s, s->outputs ^ value);
  372. break;
  373. case 0x40: /* GPIO_LEVELDETECT0 */
  374. s->level[0] = value;
  375. omap2_gpio_module_level_update(s, 0);
  376. omap2_gpio_module_level_update(s, 1);
  377. break;
  378. case 0x44: /* GPIO_LEVELDETECT1 */
  379. s->level[1] = value;
  380. omap2_gpio_module_level_update(s, 0);
  381. omap2_gpio_module_level_update(s, 1);
  382. break;
  383. case 0x48: /* GPIO_RISINGDETECT */
  384. s->edge[0] = value;
  385. break;
  386. case 0x4c: /* GPIO_FALLINGDETECT */
  387. s->edge[1] = value;
  388. break;
  389. case 0x50: /* GPIO_DEBOUNCENABLE */
  390. s->debounce = value;
  391. break;
  392. case 0x54: /* GPIO_DEBOUNCINGTIME */
  393. s->delay = value;
  394. break;
  395. case 0x60: /* GPIO_CLEARIRQENABLE1 */
  396. s->mask[0] &= ~value;
  397. omap2_gpio_module_int_update(s, 0);
  398. break;
  399. case 0x64: /* GPIO_SETIRQENABLE1 */
  400. s->mask[0] |= value;
  401. omap2_gpio_module_int_update(s, 0);
  402. break;
  403. case 0x70: /* GPIO_CLEARIRQENABLE2 */
  404. s->mask[1] &= ~value;
  405. omap2_gpio_module_int_update(s, 1);
  406. break;
  407. case 0x74: /* GPIO_SETIREQNEABLE2 */
  408. s->mask[1] |= value;
  409. omap2_gpio_module_int_update(s, 1);
  410. break;
  411. case 0x80: /* GPIO_CLEARWKUENA */
  412. s->wumask &= ~value;
  413. break;
  414. case 0x84: /* GPIO_SETWKUENA */
  415. s->wumask |= value;
  416. break;
  417. case 0x90: /* GPIO_CLEARDATAOUT */
  418. omap2_gpio_module_out_update(s, s->outputs & value);
  419. break;
  420. case 0x94: /* GPIO_SETDATAOUT */
  421. omap2_gpio_module_out_update(s, ~s->outputs & value);
  422. break;
  423. default:
  424. OMAP_BAD_REG(addr);
  425. return;
  426. }
  427. }
  428. static uint64_t omap2_gpio_module_readp(void *opaque, hwaddr addr,
  429. unsigned size)
  430. {
  431. return omap2_gpio_module_read(opaque, addr & ~3) >> ((addr & 3) << 3);
  432. }
  433. static void omap2_gpio_module_writep(void *opaque, hwaddr addr,
  434. uint64_t value, unsigned size)
  435. {
  436. uint32_t cur = 0;
  437. uint32_t mask = 0xffff;
  438. if (size == 4) {
  439. omap2_gpio_module_write(opaque, addr, value);
  440. return;
  441. }
  442. switch (addr & ~3) {
  443. case 0x00: /* GPIO_REVISION */
  444. case 0x14: /* GPIO_SYSSTATUS */
  445. case 0x38: /* GPIO_DATAIN */
  446. OMAP_RO_REG(addr);
  447. break;
  448. case 0x10: /* GPIO_SYSCONFIG */
  449. case 0x1c: /* GPIO_IRQENABLE1 */
  450. case 0x20: /* GPIO_WAKEUPENABLE */
  451. case 0x2c: /* GPIO_IRQENABLE2 */
  452. case 0x30: /* GPIO_CTRL */
  453. case 0x34: /* GPIO_OE */
  454. case 0x3c: /* GPIO_DATAOUT */
  455. case 0x40: /* GPIO_LEVELDETECT0 */
  456. case 0x44: /* GPIO_LEVELDETECT1 */
  457. case 0x48: /* GPIO_RISINGDETECT */
  458. case 0x4c: /* GPIO_FALLINGDETECT */
  459. case 0x50: /* GPIO_DEBOUNCENABLE */
  460. case 0x54: /* GPIO_DEBOUNCINGTIME */
  461. cur = omap2_gpio_module_read(opaque, addr & ~3) &
  462. ~(mask << ((addr & 3) << 3));
  463. /* Fall through. */
  464. case 0x18: /* GPIO_IRQSTATUS1 */
  465. case 0x28: /* GPIO_IRQSTATUS2 */
  466. case 0x60: /* GPIO_CLEARIRQENABLE1 */
  467. case 0x64: /* GPIO_SETIRQENABLE1 */
  468. case 0x70: /* GPIO_CLEARIRQENABLE2 */
  469. case 0x74: /* GPIO_SETIREQNEABLE2 */
  470. case 0x80: /* GPIO_CLEARWKUENA */
  471. case 0x84: /* GPIO_SETWKUENA */
  472. case 0x90: /* GPIO_CLEARDATAOUT */
  473. case 0x94: /* GPIO_SETDATAOUT */
  474. value <<= (addr & 3) << 3;
  475. omap2_gpio_module_write(opaque, addr, cur | value);
  476. break;
  477. default:
  478. OMAP_BAD_REG(addr);
  479. return;
  480. }
  481. }
  482. static const MemoryRegionOps omap2_gpio_module_ops = {
  483. .read = omap2_gpio_module_readp,
  484. .write = omap2_gpio_module_writep,
  485. .valid.min_access_size = 1,
  486. .valid.max_access_size = 4,
  487. .endianness = DEVICE_NATIVE_ENDIAN,
  488. };
  489. static void omap_gpif_reset(DeviceState *dev)
  490. {
  491. struct omap_gpif_s *s = OMAP1_GPIO(dev);
  492. omap_gpio_reset(&s->omap1);
  493. }
  494. static void omap2_gpif_reset(DeviceState *dev)
  495. {
  496. struct omap2_gpif_s *s = OMAP2_GPIO(dev);
  497. int i;
  498. for (i = 0; i < s->modulecount; i++) {
  499. omap2_gpio_module_reset(&s->modules[i]);
  500. }
  501. s->autoidle = 0;
  502. s->gpo = 0;
  503. }
  504. static uint64_t omap2_gpif_top_read(void *opaque, hwaddr addr,
  505. unsigned size)
  506. {
  507. struct omap2_gpif_s *s = (struct omap2_gpif_s *) opaque;
  508. switch (addr) {
  509. case 0x00: /* IPGENERICOCPSPL_REVISION */
  510. return 0x18;
  511. case 0x10: /* IPGENERICOCPSPL_SYSCONFIG */
  512. return s->autoidle;
  513. case 0x14: /* IPGENERICOCPSPL_SYSSTATUS */
  514. return 0x01;
  515. case 0x18: /* IPGENERICOCPSPL_IRQSTATUS */
  516. return 0x00;
  517. case 0x40: /* IPGENERICOCPSPL_GPO */
  518. return s->gpo;
  519. case 0x50: /* IPGENERICOCPSPL_GPI */
  520. return 0x00;
  521. }
  522. OMAP_BAD_REG(addr);
  523. return 0;
  524. }
  525. static void omap2_gpif_top_write(void *opaque, hwaddr addr,
  526. uint64_t value, unsigned size)
  527. {
  528. struct omap2_gpif_s *s = (struct omap2_gpif_s *) opaque;
  529. switch (addr) {
  530. case 0x00: /* IPGENERICOCPSPL_REVISION */
  531. case 0x14: /* IPGENERICOCPSPL_SYSSTATUS */
  532. case 0x18: /* IPGENERICOCPSPL_IRQSTATUS */
  533. case 0x50: /* IPGENERICOCPSPL_GPI */
  534. OMAP_RO_REG(addr);
  535. break;
  536. case 0x10: /* IPGENERICOCPSPL_SYSCONFIG */
  537. if (value & (1 << 1)) /* SOFTRESET */
  538. omap2_gpif_reset(DEVICE(s));
  539. s->autoidle = value & 1;
  540. break;
  541. case 0x40: /* IPGENERICOCPSPL_GPO */
  542. s->gpo = value & 1;
  543. break;
  544. default:
  545. OMAP_BAD_REG(addr);
  546. return;
  547. }
  548. }
  549. static const MemoryRegionOps omap2_gpif_top_ops = {
  550. .read = omap2_gpif_top_read,
  551. .write = omap2_gpif_top_write,
  552. .endianness = DEVICE_NATIVE_ENDIAN,
  553. };
  554. static void omap_gpio_init(Object *obj)
  555. {
  556. DeviceState *dev = DEVICE(obj);
  557. struct omap_gpif_s *s = OMAP1_GPIO(obj);
  558. SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
  559. qdev_init_gpio_in(dev, omap_gpio_set, 16);
  560. qdev_init_gpio_out(dev, s->omap1.handler, 16);
  561. sysbus_init_irq(sbd, &s->omap1.irq);
  562. memory_region_init_io(&s->iomem, obj, &omap_gpio_ops, &s->omap1,
  563. "omap.gpio", 0x1000);
  564. sysbus_init_mmio(sbd, &s->iomem);
  565. }
  566. static void omap_gpio_realize(DeviceState *dev, Error **errp)
  567. {
  568. struct omap_gpif_s *s = OMAP1_GPIO(dev);
  569. if (!s->clk) {
  570. error_setg(errp, "omap-gpio: clk not connected");
  571. }
  572. }
  573. static void omap2_gpio_realize(DeviceState *dev, Error **errp)
  574. {
  575. struct omap2_gpif_s *s = OMAP2_GPIO(dev);
  576. SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
  577. int i;
  578. if (!s->iclk) {
  579. error_setg(errp, "omap2-gpio: iclk not connected");
  580. return;
  581. }
  582. s->modulecount = s->mpu_model < omap2430 ? 4
  583. : s->mpu_model < omap3430 ? 5
  584. : 6;
  585. if (s->mpu_model < omap3430) {
  586. memory_region_init_io(&s->iomem, OBJECT(dev), &omap2_gpif_top_ops, s,
  587. "omap2.gpio", 0x1000);
  588. sysbus_init_mmio(sbd, &s->iomem);
  589. }
  590. s->modules = g_new0(struct omap2_gpio_s, s->modulecount);
  591. s->handler = g_new0(qemu_irq, s->modulecount * 32);
  592. qdev_init_gpio_in(dev, omap2_gpio_set, s->modulecount * 32);
  593. qdev_init_gpio_out(dev, s->handler, s->modulecount * 32);
  594. for (i = 0; i < s->modulecount; i++) {
  595. struct omap2_gpio_s *m = &s->modules[i];
  596. if (!s->fclk[i]) {
  597. error_setg(errp, "omap2-gpio: fclk%d not connected", i);
  598. return;
  599. }
  600. m->revision = (s->mpu_model < omap3430) ? 0x18 : 0x25;
  601. m->handler = &s->handler[i * 32];
  602. sysbus_init_irq(sbd, &m->irq[0]); /* mpu irq */
  603. sysbus_init_irq(sbd, &m->irq[1]); /* dsp irq */
  604. sysbus_init_irq(sbd, &m->wkup);
  605. memory_region_init_io(&m->iomem, OBJECT(dev), &omap2_gpio_module_ops, m,
  606. "omap.gpio-module", 0x1000);
  607. sysbus_init_mmio(sbd, &m->iomem);
  608. }
  609. }
  610. void omap_gpio_set_clk(omap_gpif *gpio, omap_clk clk)
  611. {
  612. gpio->clk = clk;
  613. }
  614. static Property omap_gpio_properties[] = {
  615. DEFINE_PROP_INT32("mpu_model", struct omap_gpif_s, mpu_model, 0),
  616. DEFINE_PROP_END_OF_LIST(),
  617. };
  618. static void omap_gpio_class_init(ObjectClass *klass, void *data)
  619. {
  620. DeviceClass *dc = DEVICE_CLASS(klass);
  621. dc->realize = omap_gpio_realize;
  622. dc->reset = omap_gpif_reset;
  623. device_class_set_props(dc, omap_gpio_properties);
  624. /* Reason: pointer property "clk" */
  625. dc->user_creatable = false;
  626. }
  627. static const TypeInfo omap_gpio_info = {
  628. .name = TYPE_OMAP1_GPIO,
  629. .parent = TYPE_SYS_BUS_DEVICE,
  630. .instance_size = sizeof(struct omap_gpif_s),
  631. .instance_init = omap_gpio_init,
  632. .class_init = omap_gpio_class_init,
  633. };
  634. void omap2_gpio_set_iclk(omap2_gpif *gpio, omap_clk clk)
  635. {
  636. gpio->iclk = clk;
  637. }
  638. void omap2_gpio_set_fclk(omap2_gpif *gpio, uint8_t i, omap_clk clk)
  639. {
  640. assert(i <= 5);
  641. gpio->fclk[i] = clk;
  642. }
  643. static Property omap2_gpio_properties[] = {
  644. DEFINE_PROP_INT32("mpu_model", struct omap2_gpif_s, mpu_model, 0),
  645. DEFINE_PROP_END_OF_LIST(),
  646. };
  647. static void omap2_gpio_class_init(ObjectClass *klass, void *data)
  648. {
  649. DeviceClass *dc = DEVICE_CLASS(klass);
  650. dc->realize = omap2_gpio_realize;
  651. dc->reset = omap2_gpif_reset;
  652. device_class_set_props(dc, omap2_gpio_properties);
  653. /* Reason: pointer properties "iclk", "fclk0", ..., "fclk5" */
  654. dc->user_creatable = false;
  655. }
  656. static const TypeInfo omap2_gpio_info = {
  657. .name = TYPE_OMAP2_GPIO,
  658. .parent = TYPE_SYS_BUS_DEVICE,
  659. .instance_size = sizeof(struct omap2_gpif_s),
  660. .class_init = omap2_gpio_class_init,
  661. };
  662. static void omap_gpio_register_types(void)
  663. {
  664. type_register_static(&omap_gpio_info);
  665. type_register_static(&omap2_gpio_info);
  666. }
  667. type_init(omap_gpio_register_types)