2
0

omap_gpio.c 20 KB

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