2
0

rc4030.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804
  1. /*
  2. * QEMU JAZZ RC4030 chipset
  3. *
  4. * Copyright (c) 2007-2008 Hervé Poussineau
  5. *
  6. * Permission is hereby granted, free of charge, to any person obtaining a copy
  7. * of this software and associated documentation files (the "Software"), to deal
  8. * in the Software without restriction, including without limitation the rights
  9. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10. * copies of the Software, and to permit persons to whom the Software is
  11. * furnished to do so, subject to the following conditions:
  12. *
  13. * The above copyright notice and this permission notice shall be included in
  14. * all copies or substantial portions of the Software.
  15. *
  16. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22. * THE SOFTWARE.
  23. */
  24. #include "hw.h"
  25. #include "mips.h"
  26. #include "qemu-timer.h"
  27. /********************************************************/
  28. /* debug rc4030 */
  29. //#define DEBUG_RC4030
  30. //#define DEBUG_RC4030_DMA
  31. #ifdef DEBUG_RC4030
  32. #define DPRINTF(fmt, args...) \
  33. do { printf("rc4030: " fmt , ##args); } while (0)
  34. static const char* irq_names[] = { "parallel", "floppy", "sound", "video",
  35. "network", "scsi", "keyboard", "mouse", "serial0", "serial1" };
  36. #else
  37. #define DPRINTF(fmt, args...)
  38. #endif
  39. #define RC4030_ERROR(fmt, args...) \
  40. do { fprintf(stderr, "rc4030 ERROR: %s: " fmt, __func__ , ##args); } while (0)
  41. /********************************************************/
  42. /* rc4030 emulation */
  43. typedef struct dma_pagetable_entry {
  44. int32_t frame;
  45. int32_t owner;
  46. } __attribute__((packed)) dma_pagetable_entry;
  47. #define DMA_PAGESIZE 4096
  48. #define DMA_REG_ENABLE 1
  49. #define DMA_REG_COUNT 2
  50. #define DMA_REG_ADDRESS 3
  51. #define DMA_FLAG_ENABLE 0x0001
  52. #define DMA_FLAG_MEM_TO_DEV 0x0002
  53. #define DMA_FLAG_TC_INTR 0x0100
  54. #define DMA_FLAG_MEM_INTR 0x0200
  55. #define DMA_FLAG_ADDR_INTR 0x0400
  56. typedef struct rc4030State
  57. {
  58. uint32_t config; /* 0x0000: RC4030 config register */
  59. uint32_t invalid_address_register; /* 0x0010: Invalid Address register */
  60. /* DMA */
  61. uint32_t dma_regs[8][4];
  62. uint32_t dma_tl_base; /* 0x0018: DMA transl. table base */
  63. uint32_t dma_tl_limit; /* 0x0020: DMA transl. table limit */
  64. /* cache */
  65. uint32_t remote_failed_address; /* 0x0038: Remote Failed Address */
  66. uint32_t memory_failed_address; /* 0x0040: Memory Failed Address */
  67. uint32_t cache_ptag; /* 0x0048: I/O Cache Physical Tag */
  68. uint32_t cache_ltag; /* 0x0050: I/O Cache Logical Tag */
  69. uint32_t cache_bmask; /* 0x0058: I/O Cache Byte Mask */
  70. uint32_t cache_bwin; /* 0x0060: I/O Cache Buffer Window */
  71. uint32_t offset210;
  72. uint32_t nvram_protect; /* 0x0220: NV ram protect register */
  73. uint32_t offset238;
  74. uint32_t rem_speed[15];
  75. uint32_t imr_jazz; /* Local bus int enable mask */
  76. uint32_t isr_jazz; /* Local bus int source */
  77. /* timer */
  78. QEMUTimer *periodic_timer;
  79. uint32_t itr; /* Interval timer reload */
  80. qemu_irq timer_irq;
  81. qemu_irq jazz_bus_irq;
  82. } rc4030State;
  83. static void set_next_tick(rc4030State *s)
  84. {
  85. qemu_irq_lower(s->timer_irq);
  86. uint32_t tm_hz;
  87. tm_hz = 1000 / (s->itr + 1);
  88. qemu_mod_timer(s->periodic_timer, qemu_get_clock(vm_clock) + ticks_per_sec / tm_hz);
  89. }
  90. /* called for accesses to rc4030 */
  91. static uint32_t rc4030_readl(void *opaque, target_phys_addr_t addr)
  92. {
  93. rc4030State *s = opaque;
  94. uint32_t val;
  95. addr &= 0x3fff;
  96. switch (addr & ~0x3) {
  97. /* Global config register */
  98. case 0x0000:
  99. val = s->config;
  100. break;
  101. /* Invalid Address register */
  102. case 0x0010:
  103. val = s->invalid_address_register;
  104. break;
  105. /* DMA transl. table base */
  106. case 0x0018:
  107. val = s->dma_tl_base;
  108. break;
  109. /* DMA transl. table limit */
  110. case 0x0020:
  111. val = s->dma_tl_limit;
  112. break;
  113. /* Remote Failed Address */
  114. case 0x0038:
  115. val = s->remote_failed_address;
  116. break;
  117. /* Memory Failed Address */
  118. case 0x0040:
  119. val = s->memory_failed_address;
  120. break;
  121. /* I/O Cache Byte Mask */
  122. case 0x0058:
  123. val = s->cache_bmask;
  124. /* HACK */
  125. if (s->cache_bmask == (uint32_t)-1)
  126. s->cache_bmask = 0;
  127. break;
  128. /* Remote Speed Registers */
  129. case 0x0070:
  130. case 0x0078:
  131. case 0x0080:
  132. case 0x0088:
  133. case 0x0090:
  134. case 0x0098:
  135. case 0x00a0:
  136. case 0x00a8:
  137. case 0x00b0:
  138. case 0x00b8:
  139. case 0x00c0:
  140. case 0x00c8:
  141. case 0x00d0:
  142. case 0x00d8:
  143. case 0x00e0:
  144. val = s->rem_speed[(addr - 0x0070) >> 3];
  145. break;
  146. /* DMA channel base address */
  147. case 0x0100:
  148. case 0x0108:
  149. case 0x0110:
  150. case 0x0118:
  151. case 0x0120:
  152. case 0x0128:
  153. case 0x0130:
  154. case 0x0138:
  155. case 0x0140:
  156. case 0x0148:
  157. case 0x0150:
  158. case 0x0158:
  159. case 0x0160:
  160. case 0x0168:
  161. case 0x0170:
  162. case 0x0178:
  163. case 0x0180:
  164. case 0x0188:
  165. case 0x0190:
  166. case 0x0198:
  167. case 0x01a0:
  168. case 0x01a8:
  169. case 0x01b0:
  170. case 0x01b8:
  171. case 0x01c0:
  172. case 0x01c8:
  173. case 0x01d0:
  174. case 0x01d8:
  175. case 0x01e0:
  176. case 0x01e8:
  177. case 0x01f0:
  178. case 0x01f8:
  179. {
  180. int entry = (addr - 0x0100) >> 5;
  181. int idx = (addr & 0x1f) >> 3;
  182. val = s->dma_regs[entry][idx];
  183. }
  184. break;
  185. /* Offset 0x0208 */
  186. case 0x0208:
  187. val = 0;
  188. break;
  189. /* Offset 0x0210 */
  190. case 0x0210:
  191. val = s->offset210;
  192. break;
  193. /* NV ram protect register */
  194. case 0x0220:
  195. val = s->nvram_protect;
  196. break;
  197. /* Interval timer count */
  198. case 0x0230:
  199. val = 0;
  200. qemu_irq_lower(s->timer_irq);
  201. break;
  202. /* Offset 0x0238 */
  203. case 0x0238:
  204. val = s->offset238;
  205. break;
  206. default:
  207. RC4030_ERROR("invalid read [" TARGET_FMT_plx "]\n", addr);
  208. val = 0;
  209. break;
  210. }
  211. if ((addr & ~3) != 0x230)
  212. DPRINTF("read 0x%02x at " TARGET_FMT_plx "\n", val, addr);
  213. return val;
  214. }
  215. static uint32_t rc4030_readw(void *opaque, target_phys_addr_t addr)
  216. {
  217. uint32_t v = rc4030_readl(opaque, addr & ~0x3);
  218. if (addr & 0x2)
  219. return v >> 16;
  220. else
  221. return v & 0xffff;
  222. }
  223. static uint32_t rc4030_readb(void *opaque, target_phys_addr_t addr)
  224. {
  225. uint32_t v = rc4030_readl(opaque, addr & ~0x3);
  226. return (v >> (8 * (addr & 0x3))) & 0xff;
  227. }
  228. static void rc4030_writel(void *opaque, target_phys_addr_t addr, uint32_t val)
  229. {
  230. rc4030State *s = opaque;
  231. addr &= 0x3fff;
  232. DPRINTF("write 0x%02x at " TARGET_FMT_plx "\n", val, addr);
  233. switch (addr & ~0x3) {
  234. /* Global config register */
  235. case 0x0000:
  236. s->config = val;
  237. break;
  238. /* DMA transl. table base */
  239. case 0x0018:
  240. s->dma_tl_base = val;
  241. break;
  242. /* DMA transl. table limit */
  243. case 0x0020:
  244. s->dma_tl_limit = val;
  245. break;
  246. /* DMA transl. table invalidated */
  247. case 0x0028:
  248. break;
  249. /* Cache Maintenance */
  250. case 0x0030:
  251. RC4030_ERROR("Cache maintenance not handled yet (val 0x%02x)\n", val);
  252. break;
  253. /* I/O Cache Physical Tag */
  254. case 0x0048:
  255. s->cache_ptag = val;
  256. break;
  257. /* I/O Cache Logical Tag */
  258. case 0x0050:
  259. s->cache_ltag = val;
  260. break;
  261. /* I/O Cache Byte Mask */
  262. case 0x0058:
  263. s->cache_bmask |= val; /* HACK */
  264. break;
  265. /* I/O Cache Buffer Window */
  266. case 0x0060:
  267. s->cache_bwin = val;
  268. /* HACK */
  269. if (s->cache_ltag == 0x80000001 && s->cache_bmask == 0xf0f0f0f) {
  270. target_phys_addr_t dests[] = { 4, 0, 8, 0x10 };
  271. static int current = 0;
  272. target_phys_addr_t dest = 0 + dests[current];
  273. uint8_t buf;
  274. current = (current + 1) % (ARRAY_SIZE(dests));
  275. buf = s->cache_bwin - 1;
  276. cpu_physical_memory_rw(dest, &buf, 1, 1);
  277. }
  278. break;
  279. /* Remote Speed Registers */
  280. case 0x0070:
  281. case 0x0078:
  282. case 0x0080:
  283. case 0x0088:
  284. case 0x0090:
  285. case 0x0098:
  286. case 0x00a0:
  287. case 0x00a8:
  288. case 0x00b0:
  289. case 0x00b8:
  290. case 0x00c0:
  291. case 0x00c8:
  292. case 0x00d0:
  293. case 0x00d8:
  294. case 0x00e0:
  295. s->rem_speed[(addr - 0x0070) >> 3] = val;
  296. break;
  297. /* DMA channel base address */
  298. case 0x0100:
  299. case 0x0108:
  300. case 0x0110:
  301. case 0x0118:
  302. case 0x0120:
  303. case 0x0128:
  304. case 0x0130:
  305. case 0x0138:
  306. case 0x0140:
  307. case 0x0148:
  308. case 0x0150:
  309. case 0x0158:
  310. case 0x0160:
  311. case 0x0168:
  312. case 0x0170:
  313. case 0x0178:
  314. case 0x0180:
  315. case 0x0188:
  316. case 0x0190:
  317. case 0x0198:
  318. case 0x01a0:
  319. case 0x01a8:
  320. case 0x01b0:
  321. case 0x01b8:
  322. case 0x01c0:
  323. case 0x01c8:
  324. case 0x01d0:
  325. case 0x01d8:
  326. case 0x01e0:
  327. case 0x01e8:
  328. case 0x01f0:
  329. case 0x01f8:
  330. {
  331. int entry = (addr - 0x0100) >> 5;
  332. int idx = (addr & 0x1f) >> 3;
  333. s->dma_regs[entry][idx] = val;
  334. }
  335. break;
  336. /* Offset 0x0210 */
  337. case 0x0210:
  338. s->offset210 = val;
  339. break;
  340. /* Interval timer reload */
  341. case 0x0228:
  342. s->itr = val;
  343. qemu_irq_lower(s->timer_irq);
  344. set_next_tick(s);
  345. break;
  346. default:
  347. RC4030_ERROR("invalid write of 0x%02x at [" TARGET_FMT_plx "]\n", val, addr);
  348. break;
  349. }
  350. }
  351. static void rc4030_writew(void *opaque, target_phys_addr_t addr, uint32_t val)
  352. {
  353. uint32_t old_val = rc4030_readl(opaque, addr & ~0x3);
  354. if (addr & 0x2)
  355. val = (val << 16) | (old_val & 0x0000ffff);
  356. else
  357. val = val | (old_val & 0xffff0000);
  358. rc4030_writel(opaque, addr & ~0x3, val);
  359. }
  360. static void rc4030_writeb(void *opaque, target_phys_addr_t addr, uint32_t val)
  361. {
  362. uint32_t old_val = rc4030_readl(opaque, addr & ~0x3);
  363. switch (addr & 3) {
  364. case 0:
  365. val = val | (old_val & 0xffffff00);
  366. break;
  367. case 1:
  368. val = (val << 8) | (old_val & 0xffff00ff);
  369. break;
  370. case 2:
  371. val = (val << 16) | (old_val & 0xff00ffff);
  372. break;
  373. case 3:
  374. val = (val << 24) | (old_val & 0x00ffffff);
  375. break;
  376. }
  377. rc4030_writel(opaque, addr & ~0x3, val);
  378. }
  379. static CPUReadMemoryFunc *rc4030_read[3] = {
  380. rc4030_readb,
  381. rc4030_readw,
  382. rc4030_readl,
  383. };
  384. static CPUWriteMemoryFunc *rc4030_write[3] = {
  385. rc4030_writeb,
  386. rc4030_writew,
  387. rc4030_writel,
  388. };
  389. static void update_jazz_irq(rc4030State *s)
  390. {
  391. uint16_t pending;
  392. pending = s->isr_jazz & s->imr_jazz;
  393. #ifdef DEBUG_RC4030
  394. if (s->isr_jazz != 0) {
  395. uint32_t irq = 0;
  396. DPRINTF("pending irqs:");
  397. for (irq = 0; irq < ARRAY_SIZE(irq_names); irq++) {
  398. if (s->isr_jazz & (1 << irq)) {
  399. printf(" %s", irq_names[irq]);
  400. if (!(s->imr_jazz & (1 << irq))) {
  401. printf("(ignored)");
  402. }
  403. }
  404. }
  405. printf("\n");
  406. }
  407. #endif
  408. if (pending != 0)
  409. qemu_irq_raise(s->jazz_bus_irq);
  410. else
  411. qemu_irq_lower(s->jazz_bus_irq);
  412. }
  413. static void rc4030_irq_jazz_request(void *opaque, int irq, int level)
  414. {
  415. rc4030State *s = opaque;
  416. if (level) {
  417. s->isr_jazz |= 1 << irq;
  418. } else {
  419. s->isr_jazz &= ~(1 << irq);
  420. }
  421. update_jazz_irq(s);
  422. }
  423. static void rc4030_periodic_timer(void *opaque)
  424. {
  425. rc4030State *s = opaque;
  426. set_next_tick(s);
  427. qemu_irq_raise(s->timer_irq);
  428. }
  429. static uint32_t jazzio_readw(void *opaque, target_phys_addr_t addr)
  430. {
  431. rc4030State *s = opaque;
  432. uint32_t val;
  433. uint32_t irq;
  434. addr &= 0xfff;
  435. switch (addr) {
  436. /* Local bus int source */
  437. case 0x00: {
  438. uint32_t pending = s->isr_jazz & s->imr_jazz;
  439. val = 0;
  440. irq = 0;
  441. while (pending) {
  442. if (pending & 1) {
  443. DPRINTF("returning irq %s\n", irq_names[irq]);
  444. val = (irq + 1) << 2;
  445. break;
  446. }
  447. irq++;
  448. pending >>= 1;
  449. }
  450. break;
  451. }
  452. /* Local bus int enable mask */
  453. case 0x02:
  454. val = s->imr_jazz;
  455. break;
  456. default:
  457. RC4030_ERROR("(jazz io controller) invalid read [" TARGET_FMT_plx "]\n", addr);
  458. val = 0;
  459. }
  460. DPRINTF("(jazz io controller) read 0x%04x at " TARGET_FMT_plx "\n", val, addr);
  461. return val;
  462. }
  463. static uint32_t jazzio_readb(void *opaque, target_phys_addr_t addr)
  464. {
  465. uint32_t v;
  466. v = jazzio_readw(opaque, addr & ~0x1);
  467. return (v >> (8 * (addr & 0x1))) & 0xff;
  468. }
  469. static uint32_t jazzio_readl(void *opaque, target_phys_addr_t addr)
  470. {
  471. uint32_t v;
  472. v = jazzio_readw(opaque, addr);
  473. v |= jazzio_readw(opaque, addr + 2) << 16;
  474. return v;
  475. }
  476. static void jazzio_writew(void *opaque, target_phys_addr_t addr, uint32_t val)
  477. {
  478. rc4030State *s = opaque;
  479. addr &= 0xfff;
  480. DPRINTF("(jazz io controller) write 0x%04x at " TARGET_FMT_plx "\n", val, addr);
  481. switch (addr) {
  482. /* Local bus int enable mask */
  483. case 0x02:
  484. s->imr_jazz = val;
  485. update_jazz_irq(s);
  486. break;
  487. default:
  488. RC4030_ERROR("(jazz io controller) invalid write of 0x%04x at [" TARGET_FMT_plx "]\n", val, addr);
  489. break;
  490. }
  491. }
  492. static void jazzio_writeb(void *opaque, target_phys_addr_t addr, uint32_t val)
  493. {
  494. uint32_t old_val = jazzio_readw(opaque, addr & ~0x1);
  495. switch (addr & 1) {
  496. case 0:
  497. val = val | (old_val & 0xff00);
  498. break;
  499. case 1:
  500. val = (val << 8) | (old_val & 0x00ff);
  501. break;
  502. }
  503. jazzio_writew(opaque, addr & ~0x1, val);
  504. }
  505. static void jazzio_writel(void *opaque, target_phys_addr_t addr, uint32_t val)
  506. {
  507. jazzio_writew(opaque, addr, val & 0xffff);
  508. jazzio_writew(opaque, addr + 2, (val >> 16) & 0xffff);
  509. }
  510. static CPUReadMemoryFunc *jazzio_read[3] = {
  511. jazzio_readb,
  512. jazzio_readw,
  513. jazzio_readl,
  514. };
  515. static CPUWriteMemoryFunc *jazzio_write[3] = {
  516. jazzio_writeb,
  517. jazzio_writew,
  518. jazzio_writel,
  519. };
  520. static void rc4030_reset(void *opaque)
  521. {
  522. rc4030State *s = opaque;
  523. int i;
  524. s->config = 0x410; /* some boards seem to accept 0x104 too */
  525. s->invalid_address_register = 0;
  526. memset(s->dma_regs, 0, sizeof(s->dma_regs));
  527. s->dma_tl_base = s->dma_tl_limit = 0;
  528. s->remote_failed_address = s->memory_failed_address = 0;
  529. s->cache_ptag = s->cache_ltag = 0;
  530. s->cache_bmask = s->cache_bwin = 0;
  531. s->offset210 = 0x18186;
  532. s->nvram_protect = 7;
  533. s->offset238 = 7;
  534. for (i = 0; i < 15; i++)
  535. s->rem_speed[i] = 7;
  536. s->imr_jazz = s->isr_jazz = 0;
  537. s->itr = 0;
  538. qemu_irq_lower(s->timer_irq);
  539. qemu_irq_lower(s->jazz_bus_irq);
  540. }
  541. static int rc4030_load(QEMUFile *f, void *opaque, int version_id)
  542. {
  543. rc4030State* s = opaque;
  544. int i, j;
  545. if (version_id != 1)
  546. return -EINVAL;
  547. s->config = qemu_get_be32(f);
  548. s->invalid_address_register = qemu_get_be32(f);
  549. for (i = 0; i < 8; i++)
  550. for (j = 0; j < 4; j++)
  551. s->dma_regs[i][j] = qemu_get_be32(f);
  552. s->dma_tl_base = qemu_get_be32(f);
  553. s->dma_tl_limit = qemu_get_be32(f);
  554. s->remote_failed_address = qemu_get_be32(f);
  555. s->memory_failed_address = qemu_get_be32(f);
  556. s->cache_ptag = qemu_get_be32(f);
  557. s->cache_ltag = qemu_get_be32(f);
  558. s->cache_bmask = qemu_get_be32(f);
  559. s->cache_bwin = qemu_get_be32(f);
  560. s->offset210 = qemu_get_be32(f);
  561. s->nvram_protect = qemu_get_be32(f);
  562. s->offset238 = qemu_get_be32(f);
  563. for (i = 0; i < 15; i++)
  564. s->rem_speed[i] = qemu_get_be32(f);
  565. s->imr_jazz = qemu_get_be32(f);
  566. s->isr_jazz = qemu_get_be32(f);
  567. s->itr = qemu_get_be32(f);
  568. set_next_tick(s);
  569. update_jazz_irq(s);
  570. return 0;
  571. }
  572. static void rc4030_save(QEMUFile *f, void *opaque)
  573. {
  574. rc4030State* s = opaque;
  575. int i, j;
  576. qemu_put_be32(f, s->config);
  577. qemu_put_be32(f, s->invalid_address_register);
  578. for (i = 0; i < 8; i++)
  579. for (j = 0; j < 4; j++)
  580. qemu_put_be32(f, s->dma_regs[i][j]);
  581. qemu_put_be32(f, s->dma_tl_base);
  582. qemu_put_be32(f, s->dma_tl_limit);
  583. qemu_put_be32(f, s->remote_failed_address);
  584. qemu_put_be32(f, s->memory_failed_address);
  585. qemu_put_be32(f, s->cache_ptag);
  586. qemu_put_be32(f, s->cache_ltag);
  587. qemu_put_be32(f, s->cache_bmask);
  588. qemu_put_be32(f, s->cache_bwin);
  589. qemu_put_be32(f, s->offset210);
  590. qemu_put_be32(f, s->nvram_protect);
  591. qemu_put_be32(f, s->offset238);
  592. for (i = 0; i < 15; i++)
  593. qemu_put_be32(f, s->rem_speed[i]);
  594. qemu_put_be32(f, s->imr_jazz);
  595. qemu_put_be32(f, s->isr_jazz);
  596. qemu_put_be32(f, s->itr);
  597. }
  598. static void rc4030_do_dma(void *opaque, int n, uint8_t *buf, int len, int is_write)
  599. {
  600. rc4030State *s = opaque;
  601. target_phys_addr_t entry_addr;
  602. target_phys_addr_t dma_addr, phys_addr;
  603. dma_pagetable_entry entry;
  604. int index, dev_to_mem;
  605. int ncpy, i;
  606. s->dma_regs[n][DMA_REG_ENABLE] &= ~(DMA_FLAG_TC_INTR | DMA_FLAG_MEM_INTR | DMA_FLAG_ADDR_INTR);
  607. /* Check DMA channel consistency */
  608. dev_to_mem = (s->dma_regs[n][DMA_REG_ENABLE] & DMA_FLAG_MEM_TO_DEV) ? 0 : 1;
  609. if (!(s->dma_regs[n][DMA_REG_ENABLE] & DMA_FLAG_ENABLE) ||
  610. (is_write != dev_to_mem)) {
  611. s->dma_regs[n][DMA_REG_ENABLE] |= DMA_FLAG_MEM_INTR;
  612. return;
  613. }
  614. if (len > s->dma_regs[n][DMA_REG_COUNT])
  615. len = s->dma_regs[n][DMA_REG_COUNT];
  616. dma_addr = s->dma_regs[n][DMA_REG_ADDRESS];
  617. i = 0;
  618. for (;;) {
  619. if (i == len) {
  620. s->dma_regs[n][DMA_REG_ENABLE] |= DMA_FLAG_TC_INTR;
  621. break;
  622. }
  623. ncpy = DMA_PAGESIZE - (dma_addr & (DMA_PAGESIZE - 1));
  624. if (ncpy > len - i)
  625. ncpy = len - i;
  626. /* Get DMA translation table entry */
  627. index = dma_addr / DMA_PAGESIZE;
  628. if (index >= s->dma_tl_limit / sizeof(dma_pagetable_entry)) {
  629. s->dma_regs[n][DMA_REG_ENABLE] |= DMA_FLAG_MEM_INTR;
  630. break;
  631. }
  632. entry_addr = s->dma_tl_base + index * sizeof(dma_pagetable_entry);
  633. /* XXX: not sure. should we really use only lowest bits? */
  634. entry_addr &= 0x7fffffff;
  635. cpu_physical_memory_rw(entry_addr, (uint8_t *)&entry, sizeof(entry), 0);
  636. /* Read/write data at right place */
  637. phys_addr = entry.frame + (dma_addr & (DMA_PAGESIZE - 1));
  638. cpu_physical_memory_rw(phys_addr, &buf[i], ncpy, is_write);
  639. i += ncpy;
  640. dma_addr += ncpy;
  641. s->dma_regs[n][DMA_REG_COUNT] -= ncpy;
  642. }
  643. #ifdef DEBUG_RC4030_DMA
  644. {
  645. int i, j;
  646. printf("rc4030 dma: Copying %d bytes %s host %p\n",
  647. len, is_write ? "from" : "to", buf);
  648. for (i = 0; i < len; i += 16) {
  649. int n = min(16, len - i);
  650. for (j = 0; j < n; j++)
  651. printf("%02x ", buf[i + j]);
  652. while (j++ < 16)
  653. printf(" ");
  654. printf("| ");
  655. for (j = 0; j < n; j++)
  656. printf("%c", isprint(buf[i + j]) ? buf[i + j] : '.');
  657. printf("\n");
  658. }
  659. }
  660. #endif
  661. }
  662. struct rc4030DMAState {
  663. void *opaque;
  664. int n;
  665. };
  666. static void rc4030_dma_read(void *dma, uint8_t *buf, int len)
  667. {
  668. rc4030_dma s = dma;
  669. rc4030_do_dma(s->opaque, s->n, buf, len, 0);
  670. }
  671. static void rc4030_dma_write(void *dma, uint8_t *buf, int len)
  672. {
  673. rc4030_dma s = dma;
  674. rc4030_do_dma(s->opaque, s->n, buf, len, 1);
  675. }
  676. static rc4030_dma *rc4030_allocate_dmas(void *opaque, int n)
  677. {
  678. rc4030_dma *s;
  679. struct rc4030DMAState *p;
  680. int i;
  681. s = (rc4030_dma *)qemu_mallocz(sizeof(rc4030_dma) * n);
  682. p = (struct rc4030DMAState *)qemu_mallocz(sizeof(struct rc4030DMAState) * n);
  683. for (i = 0; i < n; i++) {
  684. p->opaque = opaque;
  685. p->n = i;
  686. s[i] = p;
  687. p++;
  688. }
  689. return s;
  690. }
  691. qemu_irq *rc4030_init(qemu_irq timer, qemu_irq jazz_bus,
  692. rc4030_dma **dmas,
  693. rc4030_dma_function *dma_read, rc4030_dma_function *dma_write)
  694. {
  695. rc4030State *s;
  696. int s_chipset, s_jazzio;
  697. s = qemu_mallocz(sizeof(rc4030State));
  698. *dmas = rc4030_allocate_dmas(s, 4);
  699. *dma_read = rc4030_dma_read;
  700. *dma_write = rc4030_dma_write;
  701. s->periodic_timer = qemu_new_timer(vm_clock, rc4030_periodic_timer, s);
  702. s->timer_irq = timer;
  703. s->jazz_bus_irq = jazz_bus;
  704. qemu_register_reset(rc4030_reset, s);
  705. register_savevm("rc4030", 0, 1, rc4030_save, rc4030_load, s);
  706. rc4030_reset(s);
  707. s_chipset = cpu_register_io_memory(0, rc4030_read, rc4030_write, s);
  708. cpu_register_physical_memory(0x80000000, 0x300, s_chipset);
  709. s_jazzio = cpu_register_io_memory(0, jazzio_read, jazzio_write, s);
  710. cpu_register_physical_memory(0xf0000000, 0x00001000, s_jazzio);
  711. return qemu_allocate_irqs(rc4030_irq_jazz_request, s, 16);
  712. }