pmu.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870
  1. /*
  2. * QEMU PowerMac PMU device support
  3. *
  4. * Copyright (c) 2016 Benjamin Herrenschmidt, IBM Corp.
  5. * Copyright (c) 2018 Mark Cave-Ayland
  6. *
  7. * Based on the CUDA device by:
  8. *
  9. * Copyright (c) 2004-2007 Fabrice Bellard
  10. * Copyright (c) 2007 Jocelyn Mayer
  11. *
  12. * Permission is hereby granted, free of charge, to any person obtaining a copy
  13. * of this software and associated documentation files (the "Software"), to deal
  14. * in the Software without restriction, including without limitation the rights
  15. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  16. * copies of the Software, and to permit persons to whom the Software is
  17. * furnished to do so, subject to the following conditions:
  18. *
  19. * The above copyright notice and this permission notice shall be included in
  20. * all copies or substantial portions of the Software.
  21. *
  22. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  23. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  24. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  25. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  26. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  27. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  28. * THE SOFTWARE.
  29. */
  30. #include "qemu/osdep.h"
  31. #include "qemu-common.h"
  32. #include "hw/ppc/mac.h"
  33. #include "hw/qdev-properties.h"
  34. #include "migration/vmstate.h"
  35. #include "hw/input/adb.h"
  36. #include "hw/irq.h"
  37. #include "hw/misc/mos6522.h"
  38. #include "hw/misc/macio/gpio.h"
  39. #include "hw/misc/macio/pmu.h"
  40. #include "qapi/error.h"
  41. #include "qemu/timer.h"
  42. #include "sysemu/runstate.h"
  43. #include "qapi/error.h"
  44. #include "qemu/cutils.h"
  45. #include "qemu/log.h"
  46. #include "qemu/module.h"
  47. #include "trace.h"
  48. /* Bits in B data register: all active low */
  49. #define TACK 0x08 /* Transfer request (input) */
  50. #define TREQ 0x10 /* Transfer acknowledge (output) */
  51. /* PMU returns time_t's offset from Jan 1, 1904, not 1970 */
  52. #define RTC_OFFSET 2082844800
  53. #define VIA_TIMER_FREQ (4700000 / 6)
  54. static void via_update_irq(PMUState *s)
  55. {
  56. MOS6522PMUState *mps = MOS6522_PMU(&s->mos6522_pmu);
  57. MOS6522State *ms = MOS6522(mps);
  58. bool new_state = !!(ms->ifr & ms->ier & (SR_INT | T1_INT | T2_INT));
  59. if (new_state != s->via_irq_state) {
  60. s->via_irq_state = new_state;
  61. qemu_set_irq(s->via_irq, new_state);
  62. }
  63. }
  64. static void via_set_sr_int(void *opaque)
  65. {
  66. PMUState *s = opaque;
  67. MOS6522PMUState *mps = MOS6522_PMU(&s->mos6522_pmu);
  68. MOS6522State *ms = MOS6522(mps);
  69. MOS6522DeviceClass *mdc = MOS6522_GET_CLASS(ms);
  70. mdc->set_sr_int(ms);
  71. }
  72. static void pmu_update_extirq(PMUState *s)
  73. {
  74. if ((s->intbits & s->intmask) != 0) {
  75. macio_set_gpio(s->gpio, 1, false);
  76. } else {
  77. macio_set_gpio(s->gpio, 1, true);
  78. }
  79. }
  80. static void pmu_adb_poll(void *opaque)
  81. {
  82. PMUState *s = opaque;
  83. ADBBusState *adb_bus = &s->adb_bus;
  84. int olen;
  85. if (!(s->intbits & PMU_INT_ADB)) {
  86. olen = adb_poll(adb_bus, s->adb_reply, adb_bus->autopoll_mask);
  87. trace_pmu_adb_poll(olen);
  88. if (olen > 0) {
  89. s->adb_reply_size = olen;
  90. s->intbits |= PMU_INT_ADB | PMU_INT_ADB_AUTO;
  91. pmu_update_extirq(s);
  92. }
  93. }
  94. }
  95. static void pmu_one_sec_timer(void *opaque)
  96. {
  97. PMUState *s = opaque;
  98. trace_pmu_one_sec_timer();
  99. s->intbits |= PMU_INT_TICK;
  100. pmu_update_extirq(s);
  101. s->one_sec_target += 1000;
  102. timer_mod(s->one_sec_timer, s->one_sec_target);
  103. }
  104. static void pmu_cmd_int_ack(PMUState *s,
  105. const uint8_t *in_data, uint8_t in_len,
  106. uint8_t *out_data, uint8_t *out_len)
  107. {
  108. if (in_len != 0) {
  109. qemu_log_mask(LOG_GUEST_ERROR,
  110. "PMU: INT_ACK command, invalid len: %d want: 0\n",
  111. in_len);
  112. return;
  113. }
  114. /* Make appropriate reply packet */
  115. if (s->intbits & PMU_INT_ADB) {
  116. if (!s->adb_reply_size) {
  117. qemu_log_mask(LOG_GUEST_ERROR,
  118. "Odd, PMU_INT_ADB set with no reply in buffer\n");
  119. }
  120. memcpy(out_data + 1, s->adb_reply, s->adb_reply_size);
  121. out_data[0] = s->intbits & (PMU_INT_ADB | PMU_INT_ADB_AUTO);
  122. *out_len = s->adb_reply_size + 1;
  123. s->intbits &= ~(PMU_INT_ADB | PMU_INT_ADB_AUTO);
  124. s->adb_reply_size = 0;
  125. } else {
  126. out_data[0] = s->intbits;
  127. s->intbits = 0;
  128. *out_len = 1;
  129. }
  130. pmu_update_extirq(s);
  131. }
  132. static void pmu_cmd_set_int_mask(PMUState *s,
  133. const uint8_t *in_data, uint8_t in_len,
  134. uint8_t *out_data, uint8_t *out_len)
  135. {
  136. if (in_len != 1) {
  137. qemu_log_mask(LOG_GUEST_ERROR,
  138. "PMU: SET_INT_MASK command, invalid len: %d want: 1\n",
  139. in_len);
  140. return;
  141. }
  142. trace_pmu_cmd_set_int_mask(s->intmask);
  143. s->intmask = in_data[0];
  144. pmu_update_extirq(s);
  145. }
  146. static void pmu_cmd_set_adb_autopoll(PMUState *s, uint16_t mask)
  147. {
  148. ADBBusState *adb_bus = &s->adb_bus;
  149. trace_pmu_cmd_set_adb_autopoll(mask);
  150. if (mask) {
  151. adb_set_autopoll_mask(adb_bus, mask);
  152. adb_set_autopoll_enabled(adb_bus, true);
  153. } else {
  154. adb_set_autopoll_enabled(adb_bus, false);
  155. }
  156. }
  157. static void pmu_cmd_adb(PMUState *s,
  158. const uint8_t *in_data, uint8_t in_len,
  159. uint8_t *out_data, uint8_t *out_len)
  160. {
  161. int len, adblen;
  162. uint8_t adb_cmd[255];
  163. if (in_len < 2) {
  164. qemu_log_mask(LOG_GUEST_ERROR,
  165. "PMU: ADB PACKET, invalid len: %d want at least 2\n",
  166. in_len);
  167. return;
  168. }
  169. *out_len = 0;
  170. if (!s->has_adb) {
  171. trace_pmu_cmd_adb_nobus();
  172. return;
  173. }
  174. /* Set autopoll is a special form of the command */
  175. if (in_data[0] == 0 && in_data[1] == 0x86) {
  176. uint16_t mask = in_data[2];
  177. mask = (mask << 8) | in_data[3];
  178. if (in_len != 4) {
  179. qemu_log_mask(LOG_GUEST_ERROR,
  180. "PMU: ADB Autopoll requires 4 bytes, got %d\n",
  181. in_len);
  182. return;
  183. }
  184. pmu_cmd_set_adb_autopoll(s, mask);
  185. return;
  186. }
  187. trace_pmu_cmd_adb_request(in_len, in_data[0], in_data[1], in_data[2],
  188. in_data[3], in_data[4]);
  189. *out_len = 0;
  190. /* Check ADB len */
  191. adblen = in_data[2];
  192. if (adblen > (in_len - 3)) {
  193. qemu_log_mask(LOG_GUEST_ERROR,
  194. "PMU: ADB len is %d > %d (in_len -3)...erroring\n",
  195. adblen, in_len - 3);
  196. len = -1;
  197. } else if (adblen > 252) {
  198. qemu_log_mask(LOG_GUEST_ERROR, "PMU: ADB command too big!\n");
  199. len = -1;
  200. } else {
  201. /* Format command */
  202. adb_cmd[0] = in_data[0];
  203. memcpy(&adb_cmd[1], &in_data[3], in_len - 3);
  204. len = adb_request(&s->adb_bus, s->adb_reply + 2, adb_cmd, in_len - 2);
  205. trace_pmu_cmd_adb_reply(len);
  206. }
  207. if (len > 0) {
  208. /* XXX Check this */
  209. s->adb_reply_size = len + 2;
  210. s->adb_reply[0] = 0x01;
  211. s->adb_reply[1] = len;
  212. } else {
  213. /* XXX Check this */
  214. s->adb_reply_size = 1;
  215. s->adb_reply[0] = 0x00;
  216. }
  217. s->intbits |= PMU_INT_ADB;
  218. pmu_update_extirq(s);
  219. }
  220. static void pmu_cmd_adb_poll_off(PMUState *s,
  221. const uint8_t *in_data, uint8_t in_len,
  222. uint8_t *out_data, uint8_t *out_len)
  223. {
  224. ADBBusState *adb_bus = &s->adb_bus;
  225. if (in_len != 0) {
  226. qemu_log_mask(LOG_GUEST_ERROR,
  227. "PMU: ADB POLL OFF command, invalid len: %d want: 0\n",
  228. in_len);
  229. return;
  230. }
  231. if (s->has_adb) {
  232. adb_set_autopoll_enabled(adb_bus, false);
  233. }
  234. }
  235. static void pmu_cmd_shutdown(PMUState *s,
  236. const uint8_t *in_data, uint8_t in_len,
  237. uint8_t *out_data, uint8_t *out_len)
  238. {
  239. if (in_len != 4) {
  240. qemu_log_mask(LOG_GUEST_ERROR,
  241. "PMU: SHUTDOWN command, invalid len: %d want: 4\n",
  242. in_len);
  243. return;
  244. }
  245. *out_len = 1;
  246. out_data[0] = 0;
  247. if (in_data[0] != 'M' || in_data[1] != 'A' || in_data[2] != 'T' ||
  248. in_data[3] != 'T') {
  249. qemu_log_mask(LOG_GUEST_ERROR,
  250. "PMU: SHUTDOWN command, Bad MATT signature\n");
  251. return;
  252. }
  253. qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
  254. }
  255. static void pmu_cmd_reset(PMUState *s,
  256. const uint8_t *in_data, uint8_t in_len,
  257. uint8_t *out_data, uint8_t *out_len)
  258. {
  259. if (in_len != 0) {
  260. qemu_log_mask(LOG_GUEST_ERROR,
  261. "PMU: RESET command, invalid len: %d want: 0\n",
  262. in_len);
  263. return;
  264. }
  265. qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
  266. }
  267. static void pmu_cmd_get_rtc(PMUState *s,
  268. const uint8_t *in_data, uint8_t in_len,
  269. uint8_t *out_data, uint8_t *out_len)
  270. {
  271. uint32_t ti;
  272. if (in_len != 0) {
  273. qemu_log_mask(LOG_GUEST_ERROR,
  274. "PMU: GET_RTC command, invalid len: %d want: 0\n",
  275. in_len);
  276. return;
  277. }
  278. ti = s->tick_offset + (qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
  279. / NANOSECONDS_PER_SECOND);
  280. out_data[0] = ti >> 24;
  281. out_data[1] = ti >> 16;
  282. out_data[2] = ti >> 8;
  283. out_data[3] = ti;
  284. *out_len = 4;
  285. }
  286. static void pmu_cmd_set_rtc(PMUState *s,
  287. const uint8_t *in_data, uint8_t in_len,
  288. uint8_t *out_data, uint8_t *out_len)
  289. {
  290. uint32_t ti;
  291. if (in_len != 4) {
  292. qemu_log_mask(LOG_GUEST_ERROR,
  293. "PMU: SET_RTC command, invalid len: %d want: 4\n",
  294. in_len);
  295. return;
  296. }
  297. ti = (((uint32_t)in_data[0]) << 24) + (((uint32_t)in_data[1]) << 16)
  298. + (((uint32_t)in_data[2]) << 8) + in_data[3];
  299. s->tick_offset = ti - (qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
  300. / NANOSECONDS_PER_SECOND);
  301. }
  302. static void pmu_cmd_system_ready(PMUState *s,
  303. const uint8_t *in_data, uint8_t in_len,
  304. uint8_t *out_data, uint8_t *out_len)
  305. {
  306. /* Do nothing */
  307. }
  308. static void pmu_cmd_get_version(PMUState *s,
  309. const uint8_t *in_data, uint8_t in_len,
  310. uint8_t *out_data, uint8_t *out_len)
  311. {
  312. *out_len = 1;
  313. *out_data = 1; /* ??? Check what Apple does */
  314. }
  315. static void pmu_cmd_power_events(PMUState *s,
  316. const uint8_t *in_data, uint8_t in_len,
  317. uint8_t *out_data, uint8_t *out_len)
  318. {
  319. if (in_len < 1) {
  320. qemu_log_mask(LOG_GUEST_ERROR,
  321. "PMU: POWER EVENTS command, invalid len %d, want at least 1\n",
  322. in_len);
  323. return;
  324. }
  325. switch (in_data[0]) {
  326. /* Dummies for now */
  327. case PMU_PWR_GET_POWERUP_EVENTS:
  328. *out_len = 2;
  329. out_data[0] = 0;
  330. out_data[1] = 0;
  331. break;
  332. case PMU_PWR_SET_POWERUP_EVENTS:
  333. case PMU_PWR_CLR_POWERUP_EVENTS:
  334. break;
  335. case PMU_PWR_GET_WAKEUP_EVENTS:
  336. *out_len = 2;
  337. out_data[0] = 0;
  338. out_data[1] = 0;
  339. break;
  340. case PMU_PWR_SET_WAKEUP_EVENTS:
  341. case PMU_PWR_CLR_WAKEUP_EVENTS:
  342. break;
  343. default:
  344. qemu_log_mask(LOG_GUEST_ERROR,
  345. "PMU: POWER EVENTS unknown subcommand 0x%02x\n",
  346. in_data[0]);
  347. }
  348. }
  349. static void pmu_cmd_get_cover(PMUState *s,
  350. const uint8_t *in_data, uint8_t in_len,
  351. uint8_t *out_data, uint8_t *out_len)
  352. {
  353. /* Not 100% sure here, will have to check what a real Mac
  354. * returns other than byte 0 bit 0 is LID closed on laptops
  355. */
  356. *out_len = 1;
  357. *out_data = 0x00;
  358. }
  359. static void pmu_cmd_download_status(PMUState *s,
  360. const uint8_t *in_data, uint8_t in_len,
  361. uint8_t *out_data, uint8_t *out_len)
  362. {
  363. /* This has to do with PMU firmware updates as far as I can tell.
  364. *
  365. * We return 0x62 which is what OpenPMU expects
  366. */
  367. *out_len = 1;
  368. *out_data = 0x62;
  369. }
  370. static void pmu_cmd_read_pmu_ram(PMUState *s,
  371. const uint8_t *in_data, uint8_t in_len,
  372. uint8_t *out_data, uint8_t *out_len)
  373. {
  374. if (in_len < 3) {
  375. qemu_log_mask(LOG_GUEST_ERROR,
  376. "PMU: READ_PMU_RAM command, invalid len %d, expected 3\n",
  377. in_len);
  378. return;
  379. }
  380. qemu_log_mask(LOG_GUEST_ERROR,
  381. "PMU: Unsupported READ_PMU_RAM, args: %02x %02x %02x\n",
  382. in_data[0], in_data[1], in_data[2]);
  383. *out_len = 0;
  384. }
  385. /* description of commands */
  386. typedef struct PMUCmdHandler {
  387. uint8_t command;
  388. const char *name;
  389. void (*handler)(PMUState *s,
  390. const uint8_t *in_args, uint8_t in_len,
  391. uint8_t *out_args, uint8_t *out_len);
  392. } PMUCmdHandler;
  393. static const PMUCmdHandler PMUCmdHandlers[] = {
  394. { PMU_INT_ACK, "INT ACK", pmu_cmd_int_ack },
  395. { PMU_SET_INTR_MASK, "SET INT MASK", pmu_cmd_set_int_mask },
  396. { PMU_ADB_CMD, "ADB COMMAND", pmu_cmd_adb },
  397. { PMU_ADB_POLL_OFF, "ADB POLL OFF", pmu_cmd_adb_poll_off },
  398. { PMU_RESET, "REBOOT", pmu_cmd_reset },
  399. { PMU_SHUTDOWN, "SHUTDOWN", pmu_cmd_shutdown },
  400. { PMU_READ_RTC, "GET RTC", pmu_cmd_get_rtc },
  401. { PMU_SET_RTC, "SET RTC", pmu_cmd_set_rtc },
  402. { PMU_SYSTEM_READY, "SYSTEM READY", pmu_cmd_system_ready },
  403. { PMU_GET_VERSION, "GET VERSION", pmu_cmd_get_version },
  404. { PMU_POWER_EVENTS, "POWER EVENTS", pmu_cmd_power_events },
  405. { PMU_GET_COVER, "GET_COVER", pmu_cmd_get_cover },
  406. { PMU_DOWNLOAD_STATUS, "DOWNLOAD STATUS", pmu_cmd_download_status },
  407. { PMU_READ_PMU_RAM, "READ PMGR RAM", pmu_cmd_read_pmu_ram },
  408. };
  409. static void pmu_dispatch_cmd(PMUState *s)
  410. {
  411. unsigned int i;
  412. /* No response by default */
  413. s->cmd_rsp_sz = 0;
  414. for (i = 0; i < ARRAY_SIZE(PMUCmdHandlers); i++) {
  415. const PMUCmdHandler *desc = &PMUCmdHandlers[i];
  416. if (desc->command != s->cmd) {
  417. continue;
  418. }
  419. trace_pmu_dispatch_cmd(desc->name);
  420. desc->handler(s, s->cmd_buf, s->cmd_buf_pos,
  421. s->cmd_rsp, &s->cmd_rsp_sz);
  422. if (s->rsplen != -1 && s->rsplen != s->cmd_rsp_sz) {
  423. trace_pmu_debug_protocol_string("QEMU internal cmd resp mismatch!");
  424. } else {
  425. trace_pmu_debug_protocol_resp_size(s->cmd_rsp_sz);
  426. }
  427. return;
  428. }
  429. trace_pmu_dispatch_unknown_cmd(s->cmd);
  430. /* Manufacture fake response with 0's */
  431. if (s->rsplen == -1) {
  432. s->cmd_rsp_sz = 0;
  433. } else {
  434. s->cmd_rsp_sz = s->rsplen;
  435. memset(s->cmd_rsp, 0, s->rsplen);
  436. }
  437. }
  438. static void pmu_update(PMUState *s)
  439. {
  440. MOS6522PMUState *mps = &s->mos6522_pmu;
  441. MOS6522State *ms = MOS6522(mps);
  442. ADBBusState *adb_bus = &s->adb_bus;
  443. /* Only react to changes in reg B */
  444. if (ms->b == s->last_b) {
  445. return;
  446. }
  447. s->last_b = ms->b;
  448. /* Check the TREQ / TACK state */
  449. switch (ms->b & (TREQ | TACK)) {
  450. case TREQ:
  451. /* This is an ack release, handle it and bail out */
  452. ms->b |= TACK;
  453. s->last_b = ms->b;
  454. trace_pmu_debug_protocol_string("handshake: TREQ high, setting TACK");
  455. return;
  456. case TACK:
  457. /* This is a valid request, handle below */
  458. break;
  459. case TREQ | TACK:
  460. /* This is an idle state */
  461. return;
  462. default:
  463. /* Invalid state, log and ignore */
  464. trace_pmu_debug_protocol_error(ms->b);
  465. return;
  466. }
  467. /* If we wanted to handle commands asynchronously, this is where
  468. * we would delay the clearing of TACK until we are ready to send
  469. * the response
  470. */
  471. /* We have a request, handshake TACK so we don't stay in
  472. * an invalid state. If we were concurrent with the OS we
  473. * should only do this after we grabbed the SR but that isn't
  474. * a problem here.
  475. */
  476. trace_pmu_debug_protocol_clear_treq(s->cmd_state);
  477. ms->b &= ~TACK;
  478. s->last_b = ms->b;
  479. /* Act according to state */
  480. switch (s->cmd_state) {
  481. case pmu_state_idle:
  482. if (!(ms->acr & SR_OUT)) {
  483. trace_pmu_debug_protocol_string("protocol error! "
  484. "state idle, ACR reading");
  485. break;
  486. }
  487. s->cmd = ms->sr;
  488. via_set_sr_int(s);
  489. s->cmdlen = pmu_data_len[s->cmd][0];
  490. s->rsplen = pmu_data_len[s->cmd][1];
  491. s->cmd_buf_pos = 0;
  492. s->cmd_rsp_pos = 0;
  493. s->cmd_state = pmu_state_cmd;
  494. adb_autopoll_block(adb_bus);
  495. trace_pmu_debug_protocol_cmd(s->cmd, s->cmdlen, s->rsplen);
  496. break;
  497. case pmu_state_cmd:
  498. if (!(ms->acr & SR_OUT)) {
  499. trace_pmu_debug_protocol_string("protocol error! "
  500. "state cmd, ACR reading");
  501. break;
  502. }
  503. if (s->cmdlen == -1) {
  504. trace_pmu_debug_protocol_cmdlen(ms->sr);
  505. s->cmdlen = ms->sr;
  506. if (s->cmdlen > sizeof(s->cmd_buf)) {
  507. trace_pmu_debug_protocol_cmd_toobig(s->cmdlen);
  508. }
  509. } else if (s->cmd_buf_pos < sizeof(s->cmd_buf)) {
  510. s->cmd_buf[s->cmd_buf_pos++] = ms->sr;
  511. }
  512. via_set_sr_int(s);
  513. break;
  514. case pmu_state_rsp:
  515. if (ms->acr & SR_OUT) {
  516. trace_pmu_debug_protocol_string("protocol error! "
  517. "state resp, ACR writing");
  518. break;
  519. }
  520. if (s->rsplen == -1) {
  521. trace_pmu_debug_protocol_cmd_send_resp_size(s->cmd_rsp_sz);
  522. ms->sr = s->cmd_rsp_sz;
  523. s->rsplen = s->cmd_rsp_sz;
  524. } else if (s->cmd_rsp_pos < s->cmd_rsp_sz) {
  525. trace_pmu_debug_protocol_cmd_send_resp(s->cmd_rsp_pos, s->rsplen);
  526. ms->sr = s->cmd_rsp[s->cmd_rsp_pos++];
  527. }
  528. via_set_sr_int(s);
  529. break;
  530. }
  531. /* Check for state completion */
  532. if (s->cmd_state == pmu_state_cmd && s->cmdlen == s->cmd_buf_pos) {
  533. trace_pmu_debug_protocol_string("Command reception complete, "
  534. "dispatching...");
  535. pmu_dispatch_cmd(s);
  536. s->cmd_state = pmu_state_rsp;
  537. }
  538. if (s->cmd_state == pmu_state_rsp && s->rsplen == s->cmd_rsp_pos) {
  539. trace_pmu_debug_protocol_cmd_resp_complete(ms->ier);
  540. adb_autopoll_unblock(adb_bus);
  541. s->cmd_state = pmu_state_idle;
  542. }
  543. }
  544. static uint64_t mos6522_pmu_read(void *opaque, hwaddr addr, unsigned size)
  545. {
  546. PMUState *s = opaque;
  547. MOS6522PMUState *mps = &s->mos6522_pmu;
  548. MOS6522State *ms = MOS6522(mps);
  549. addr = (addr >> 9) & 0xf;
  550. return mos6522_read(ms, addr, size);
  551. }
  552. static void mos6522_pmu_write(void *opaque, hwaddr addr, uint64_t val,
  553. unsigned size)
  554. {
  555. PMUState *s = opaque;
  556. MOS6522PMUState *mps = &s->mos6522_pmu;
  557. MOS6522State *ms = MOS6522(mps);
  558. addr = (addr >> 9) & 0xf;
  559. mos6522_write(ms, addr, val, size);
  560. }
  561. static const MemoryRegionOps mos6522_pmu_ops = {
  562. .read = mos6522_pmu_read,
  563. .write = mos6522_pmu_write,
  564. .endianness = DEVICE_BIG_ENDIAN,
  565. .impl = {
  566. .min_access_size = 1,
  567. .max_access_size = 1,
  568. },
  569. };
  570. static bool pmu_adb_state_needed(void *opaque)
  571. {
  572. PMUState *s = opaque;
  573. return s->has_adb;
  574. }
  575. static const VMStateDescription vmstate_pmu_adb = {
  576. .name = "pmu/adb",
  577. .version_id = 1,
  578. .minimum_version_id = 1,
  579. .needed = pmu_adb_state_needed,
  580. .fields = (VMStateField[]) {
  581. VMSTATE_UINT8(adb_reply_size, PMUState),
  582. VMSTATE_BUFFER(adb_reply, PMUState),
  583. VMSTATE_END_OF_LIST()
  584. }
  585. };
  586. static const VMStateDescription vmstate_pmu = {
  587. .name = "pmu",
  588. .version_id = 1,
  589. .minimum_version_id = 1,
  590. .fields = (VMStateField[]) {
  591. VMSTATE_STRUCT(mos6522_pmu.parent_obj, PMUState, 0, vmstate_mos6522,
  592. MOS6522State),
  593. VMSTATE_UINT8(last_b, PMUState),
  594. VMSTATE_UINT8(cmd, PMUState),
  595. VMSTATE_UINT32(cmdlen, PMUState),
  596. VMSTATE_UINT32(rsplen, PMUState),
  597. VMSTATE_UINT8(cmd_buf_pos, PMUState),
  598. VMSTATE_BUFFER(cmd_buf, PMUState),
  599. VMSTATE_UINT8(cmd_rsp_pos, PMUState),
  600. VMSTATE_UINT8(cmd_rsp_sz, PMUState),
  601. VMSTATE_BUFFER(cmd_rsp, PMUState),
  602. VMSTATE_UINT8(intbits, PMUState),
  603. VMSTATE_UINT8(intmask, PMUState),
  604. VMSTATE_UINT32(tick_offset, PMUState),
  605. VMSTATE_TIMER_PTR(one_sec_timer, PMUState),
  606. VMSTATE_INT64(one_sec_target, PMUState),
  607. VMSTATE_END_OF_LIST()
  608. },
  609. .subsections = (const VMStateDescription * []) {
  610. &vmstate_pmu_adb,
  611. }
  612. };
  613. static void pmu_reset(DeviceState *dev)
  614. {
  615. PMUState *s = VIA_PMU(dev);
  616. /* OpenBIOS needs to do this? MacOS 9 needs it */
  617. s->intmask = PMU_INT_ADB | PMU_INT_TICK;
  618. s->intbits = 0;
  619. s->cmd_state = pmu_state_idle;
  620. }
  621. static void pmu_realize(DeviceState *dev, Error **errp)
  622. {
  623. PMUState *s = VIA_PMU(dev);
  624. SysBusDevice *sbd;
  625. ADBBusState *adb_bus = &s->adb_bus;
  626. struct tm tm;
  627. if (!sysbus_realize(SYS_BUS_DEVICE(&s->mos6522_pmu), errp)) {
  628. return;
  629. }
  630. /* Pass IRQ from 6522 */
  631. sbd = SYS_BUS_DEVICE(s);
  632. sysbus_pass_irq(sbd, SYS_BUS_DEVICE(&s->mos6522_pmu));
  633. qemu_get_timedate(&tm, 0);
  634. s->tick_offset = (uint32_t)mktimegm(&tm) + RTC_OFFSET;
  635. s->one_sec_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL, pmu_one_sec_timer, s);
  636. s->one_sec_target = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 1000;
  637. timer_mod(s->one_sec_timer, s->one_sec_target);
  638. if (s->has_adb) {
  639. qbus_create_inplace(&s->adb_bus, sizeof(s->adb_bus), TYPE_ADB_BUS,
  640. dev, "adb.0");
  641. adb_register_autopoll_callback(adb_bus, pmu_adb_poll, s);
  642. }
  643. }
  644. static void pmu_init(Object *obj)
  645. {
  646. SysBusDevice *d = SYS_BUS_DEVICE(obj);
  647. PMUState *s = VIA_PMU(obj);
  648. object_property_add_link(obj, "gpio", TYPE_MACIO_GPIO,
  649. (Object **) &s->gpio,
  650. qdev_prop_allow_set_link_before_realize,
  651. 0);
  652. object_initialize_child(obj, "mos6522-pmu", &s->mos6522_pmu,
  653. TYPE_MOS6522_PMU);
  654. memory_region_init_io(&s->mem, obj, &mos6522_pmu_ops, s, "via-pmu",
  655. 0x2000);
  656. sysbus_init_mmio(d, &s->mem);
  657. }
  658. static Property pmu_properties[] = {
  659. DEFINE_PROP_BOOL("has-adb", PMUState, has_adb, true),
  660. DEFINE_PROP_END_OF_LIST()
  661. };
  662. static void pmu_class_init(ObjectClass *oc, void *data)
  663. {
  664. DeviceClass *dc = DEVICE_CLASS(oc);
  665. dc->realize = pmu_realize;
  666. dc->reset = pmu_reset;
  667. dc->vmsd = &vmstate_pmu;
  668. device_class_set_props(dc, pmu_properties);
  669. set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories);
  670. }
  671. static const TypeInfo pmu_type_info = {
  672. .name = TYPE_VIA_PMU,
  673. .parent = TYPE_SYS_BUS_DEVICE,
  674. .instance_size = sizeof(PMUState),
  675. .instance_init = pmu_init,
  676. .class_init = pmu_class_init,
  677. };
  678. static void mos6522_pmu_portB_write(MOS6522State *s)
  679. {
  680. MOS6522PMUState *mps = container_of(s, MOS6522PMUState, parent_obj);
  681. PMUState *ps = container_of(mps, PMUState, mos6522_pmu);
  682. if ((s->pcr & 0xe0) == 0x20 || (s->pcr & 0xe0) == 0x60) {
  683. s->ifr &= ~CB2_INT;
  684. }
  685. s->ifr &= ~CB1_INT;
  686. via_update_irq(ps);
  687. pmu_update(ps);
  688. }
  689. static void mos6522_pmu_portA_write(MOS6522State *s)
  690. {
  691. MOS6522PMUState *mps = container_of(s, MOS6522PMUState, parent_obj);
  692. PMUState *ps = container_of(mps, PMUState, mos6522_pmu);
  693. if ((s->pcr & 0x0e) == 0x02 || (s->pcr & 0x0e) == 0x06) {
  694. s->ifr &= ~CA2_INT;
  695. }
  696. s->ifr &= ~CA1_INT;
  697. via_update_irq(ps);
  698. }
  699. static void mos6522_pmu_reset(DeviceState *dev)
  700. {
  701. MOS6522State *ms = MOS6522(dev);
  702. MOS6522PMUState *mps = container_of(ms, MOS6522PMUState, parent_obj);
  703. PMUState *s = container_of(mps, PMUState, mos6522_pmu);
  704. MOS6522DeviceClass *mdc = MOS6522_GET_CLASS(ms);
  705. mdc->parent_reset(dev);
  706. ms->timers[0].frequency = VIA_TIMER_FREQ;
  707. ms->timers[1].frequency = (SCALE_US * 6000) / 4700;
  708. s->last_b = ms->b = TACK | TREQ;
  709. }
  710. static void mos6522_pmu_class_init(ObjectClass *oc, void *data)
  711. {
  712. DeviceClass *dc = DEVICE_CLASS(oc);
  713. MOS6522DeviceClass *mdc = MOS6522_CLASS(oc);
  714. dc->reset = mos6522_pmu_reset;
  715. mdc->portB_write = mos6522_pmu_portB_write;
  716. mdc->portA_write = mos6522_pmu_portA_write;
  717. }
  718. static const TypeInfo mos6522_pmu_type_info = {
  719. .name = TYPE_MOS6522_PMU,
  720. .parent = TYPE_MOS6522,
  721. .instance_size = sizeof(MOS6522PMUState),
  722. .class_init = mos6522_pmu_class_init,
  723. };
  724. static void pmu_register_types(void)
  725. {
  726. type_register_static(&pmu_type_info);
  727. type_register_static(&mos6522_pmu_type_info);
  728. }
  729. type_init(pmu_register_types)