r8c.opc 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608
  1. /* r8c.opc --- semantics for r8c opcodes. -*- mode: c -*-
  2. Copyright (C) 2005-2022 Free Software Foundation, Inc.
  3. Contributed by Red Hat, Inc.
  4. This file is part of the GNU simulators.
  5. This program is free software; you can redistribute it and/or modify
  6. it under the terms of the GNU General Public License as published by
  7. the Free Software Foundation; either version 3 of the License, or
  8. (at your option) any later version.
  9. This program is distributed in the hope that it will be useful,
  10. but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  12. GNU General Public License for more details.
  13. You should have received a copy of the GNU General Public License
  14. along with this program. If not, see <http://www.gnu.org/licenses/>. */
  15. /* This must come before any other includes. */
  16. #include "defs.h"
  17. #include <stdio.h>
  18. #include <stdlib.h>
  19. #include "ansidecl.h"
  20. #include "cpu.h"
  21. #include "mem.h"
  22. #include "misc.h"
  23. #include "int.h"
  24. #define tprintf if (trace) printf
  25. static unsigned char
  26. getbyte (void)
  27. {
  28. int tsave = trace;
  29. unsigned char b;
  30. if (trace == 1)
  31. trace = 0;
  32. b = mem_get_pc ();
  33. regs.r_pc ++;
  34. trace = tsave;
  35. return b;
  36. }
  37. #define M16C_ONLY() /* FIXME: add something here */
  38. #define GETBYTE() (op[opi++] = getbyte())
  39. #define UNSUPPORTED() unsupported("unsupported", orig_pc)
  40. #define NOTYET() unsupported("unimplemented", orig_pc)
  41. static void
  42. unsupported (char *tag, int orig_pc)
  43. {
  44. int i;
  45. printf("%s opcode at %08x\n", tag, orig_pc);
  46. regs.r_pc = orig_pc;
  47. for (i=0; i<2; i++)
  48. {
  49. int b = mem_get_pc();
  50. printf(" %s", bits(b>>4, 4));
  51. printf(" %s", bits(b, 4));
  52. regs.r_pc ++;
  53. }
  54. printf("\n");
  55. regs.r_pc = orig_pc;
  56. for (i=0; i<6; i++)
  57. {
  58. printf(" %02x", mem_get_pc ());
  59. regs.r_pc ++;
  60. }
  61. printf("\n");
  62. exit(1);
  63. }
  64. static int
  65. IMM (int bw)
  66. {
  67. int rv = getbyte ();
  68. if (bw)
  69. rv = rv + 256 * getbyte();
  70. if (bw == 2)
  71. rv = rv + 65536 * getbyte();
  72. return rv;
  73. }
  74. #define IMM4() (immm >= 8 ? 7 - immm : immm + 1)
  75. #define UNARY_SOP \
  76. dc = decode_srcdest4 (dest, w); \
  77. v = sign_ext (get_src (dc), w?16:8);
  78. #define UNARY_UOP \
  79. dc = decode_srcdest4 (dest, w); \
  80. v = get_src (dc);
  81. #define BINARY_SOP \
  82. sc = decode_srcdest4 (srcx, w); \
  83. dc = decode_srcdest4 (dest, w); \
  84. a = sign_ext (get_src (sc), w?16:8); \
  85. b = sign_ext (get_src (dc), w?16:8);
  86. #define BINARY_UOP \
  87. sc = decode_srcdest4 (srcx, w); \
  88. dc = decode_srcdest4 (dest, w); \
  89. a = get_src (sc); \
  90. b = get_src (dc);
  91. #define carry (FLAG_C ? 1 : 0)
  92. static void
  93. cmp (int d, int s, int w)
  94. {
  95. int a, b, f=0;
  96. int mask = w ? 0xffff : 0xff;
  97. a = d - s;
  98. b = sign_ext (d, w?16:8) - sign_ext (s, w?16:8);
  99. tprintf ("cmp: %x - %x = %08x, %x - %x = %d\n",
  100. d, s, a,
  101. sign_ext(d,w?16:8), sign_ext(s,w?16:8), b);
  102. if (b == 0)
  103. f |= FLAGBIT_Z;
  104. if (b & (w ? 0x8000 : 0x80))
  105. f |= FLAGBIT_S;
  106. if ((d & mask) >= (s & mask))
  107. f |= FLAGBIT_C;
  108. if (b < (w ? -32768 : -128) || b > (w ? 32767 : 127))
  109. f |= FLAGBIT_O;
  110. set_flags (FLAGBIT_Z | FLAGBIT_S | FLAGBIT_O | FLAGBIT_C, f);
  111. }
  112. static void
  113. div_op (int s, int u, int x, int w)
  114. {
  115. srcdest sc;
  116. int v, a, b;
  117. if (s == -1)
  118. s = IMM(w);
  119. else
  120. {
  121. sc = decode_srcdest4 (s, w);
  122. s = get_src (sc);
  123. }
  124. v = get_reg (w ? r2r0 : r0);
  125. if (!u)
  126. {
  127. s = sign_ext (s, w ? 16 : 8);
  128. v = sign_ext (v, w ? 16 : 8);
  129. }
  130. if (s == 0)
  131. {
  132. set_flags (FLAGBIT_O, FLAGBIT_O);
  133. return;
  134. }
  135. if (u)
  136. {
  137. a = (unsigned int)v / (unsigned int)s;
  138. b = (unsigned int)v % (unsigned int)s;
  139. }
  140. else
  141. {
  142. a = v / s;
  143. b = v % s;
  144. }
  145. if (x)
  146. {
  147. if ((s > 0 && b < 0)
  148. || (s < 0 && b > 0))
  149. {
  150. a --;
  151. b += s;
  152. }
  153. }
  154. tprintf ("%d / %d = %d rem %d\n", v, s, a, b);
  155. if ((!u && (a > (w ? 32767 : 127)
  156. || a < (w ? -32768 : -129)))
  157. || (u && (a > (w ? 65536 : 255))))
  158. set_flags (FLAGBIT_O, FLAGBIT_O);
  159. else
  160. set_flags (FLAGBIT_O, 0);
  161. put_reg (w ? r0 : r0l, a);
  162. put_reg (w ? r2 : r0h, b);
  163. }
  164. static void
  165. rot_op (srcdest sd, int rotc, int count)
  166. {
  167. int mask = (sd.bytes == 2) ? 0xffff : 0xff;
  168. int msb = (sd.bytes == 2) ? 0x8000 : 0x80;
  169. int v = get_src (sd);
  170. int c = carry, ct;
  171. tprintf("%s %x by %d\n", rotc ? "rotc" : "rot", v, count);
  172. tprintf (": %s %d\n", bits(v, 8*sd.bytes), c);
  173. while (count > 0)
  174. {
  175. ct = (v & msb) ? 1 : 0;
  176. v <<= 1;
  177. v |= rotc ? c : ct;
  178. v &= mask;
  179. c = ct;
  180. tprintf (": %s %d\n", bits(v, 8*sd.bytes), c);
  181. count --;
  182. }
  183. while (count < 0)
  184. {
  185. ct = v & 1;
  186. v >>= 1;
  187. v |= (rotc ? c : ct) * msb;
  188. c = ct;
  189. tprintf (": %s %d\n", bits(v, 8*sd.bytes), c);
  190. count ++;
  191. }
  192. put_dest (sd, v);
  193. set_szc (v, sd.bytes, c);
  194. }
  195. static void
  196. shift_op (srcdest sd, int arith, int count)
  197. {
  198. int mask = (sd.bytes == 2) ? 0xffff : 0xff;
  199. int msb = (sd.bytes == 2) ? 0x8000 : 0x80;
  200. int v = get_src (sd);
  201. int c = 0;
  202. if (sd.bytes == 4)
  203. {
  204. mask = 0xffffffffU;
  205. msb = 0x80000000U;
  206. if (count > 16 || count < -16)
  207. {
  208. fprintf(stderr, "Error: SI shift of %d undefined\n", count);
  209. exit(1);
  210. }
  211. if (count > 16)
  212. count = (count - 1) % 16 + 1;
  213. if (count < -16)
  214. count = -((-count - 1) % 16 + 1);
  215. }
  216. tprintf("%s %x by %d\n", arith ? "sha" : "shl", v, count);
  217. tprintf (": %s %d\n", bits(v, 8*sd.bytes), c);
  218. while (count > 0)
  219. {
  220. c = (v & msb) ? 1 : 0;
  221. v <<= 1;
  222. v &= mask;
  223. tprintf (": %s %d\n", bits(v, 8*sd.bytes), c);
  224. count --;
  225. }
  226. while (count < 0)
  227. {
  228. c = v & 1;
  229. if (arith)
  230. v = (v & msb) | (v >> 1);
  231. else
  232. v = (v >> 1) & (msb - 1);
  233. tprintf (": %s %d\n", bits(v, 8*sd.bytes), c);
  234. count ++;
  235. }
  236. put_dest (sd, v);
  237. set_szc (v, sd.bytes, c);
  238. }
  239. #define MATH_OP(dc,s,c,op,carryrel) \
  240. a = get_src(dc); \
  241. b = s & b2mask[dc.bytes]; \
  242. v2 = a op b op c; \
  243. tprintf("0x%x " #op " 0x%x " #op " 0x%x = 0x%x\n", a, b, c, v2); \
  244. a = sign_ext (a, dc.bytes * 8); \
  245. b = sign_ext (s, dc.bytes * 8); \
  246. v = a op b op c; \
  247. tprintf("%d " #op " %d " #op " %d = %d\n", a, b, c, v); \
  248. set_oszc (v, dc.bytes, v2 carryrel); \
  249. put_dest (dc, v2);
  250. #define BIT_OP(field,expr) \
  251. dc = decode_bit (field); \
  252. b = get_bit (dc); \
  253. v = expr; \
  254. tprintf ("b=%d, carry=%d, %s = %d\n", b, carry, #expr, v); \
  255. put_bit (dc, v);
  256. #define BIT_OPC(field,expr) \
  257. dc = decode_bit (field); \
  258. b = get_bit (dc); \
  259. v = expr; \
  260. tprintf ("b=%d, carry=%d, %s = %d\n", b, carry, #expr, v); \
  261. set_c (v);
  262. /* The "BMcnd dest" opcode uses a different encoding for the */
  263. /* condition than other opcodes. */
  264. static int bmcnd_cond_map[] = {
  265. 0, 1, 2, 3, 8, 9, 10, 11, 4, 5, 6, 7, 12, 13, 14, 15
  266. };
  267. int
  268. decode_r8c (void)
  269. {
  270. unsigned char op[40];
  271. int opi = 0;
  272. int v, v2, a, b;
  273. int orig_pc = get_reg (pc);
  274. srcdest sc, dc;
  275. int imm;
  276. step_result = M32C_MAKE_STEPPED ();
  277. tprintf("trace: decode pc = %05x\n", orig_pc);
  278. /** VARY dst 011 100 101 110 111 */
  279. /** 0111 011w 1111 dest ABS.size dest */
  280. UNARY_SOP;
  281. a = v<0 ? -v : v;
  282. tprintf("abs(%d) = %d\n", v, a);
  283. set_osz(a, w+1);
  284. put_dest (dc, a);
  285. /** 0111 011w 0110 dest ADC.size #IMM,dest */
  286. dc = decode_srcdest4(dest, w);
  287. imm = IMM(w);
  288. MATH_OP (dc, imm, carry, +, > (w?0xffff:0xff));
  289. /** 1011 000w srcx dest ADC.size src,dest */
  290. sc = decode_srcdest4(srcx, w);
  291. dc = decode_srcdest4(dest, w);
  292. b = get_src (sc);
  293. MATH_OP (dc, b, carry, +, > (w?0xffff:0xff));
  294. /** 0111 011w 1110 dest ADCF.size dest */
  295. dc = decode_srcdest4(dest, w);
  296. MATH_OP (dc, 0, carry, +, > (w?0xffff:0xff));
  297. /** 0111 011w 0100 dest ADD.size:G #imm,dest */
  298. dc = decode_srcdest4(dest, w);
  299. imm = IMM(w);
  300. MATH_OP (dc, imm, 0, +, > (w?0xffff:0xff));
  301. /** 1100 100w immm dest ADD.size:Q #IMM,dest */
  302. dc = decode_srcdest4(dest, w);
  303. imm = sign_ext (immm, 4);
  304. MATH_OP (dc, imm, 0, +, > (w?0xffff:0xff));
  305. /** 1000 0dst ADD.B:S #IMM8,dst */
  306. imm = IMM(0);
  307. dc = decode_dest3 (dst, 0);
  308. MATH_OP (dc, imm, 0, +, > 0xff);
  309. /** 1010 000w srcx dest ADD.size:G src,dest */
  310. sc = decode_srcdest4(srcx, w);
  311. dc = decode_srcdest4(dest, w);
  312. b = get_src (sc);
  313. MATH_OP (dc, b, 0, +, > (w?0xffff:0xff));
  314. /** 0010 0d sr ADD.B:S src,R0L/R0H */
  315. sc = decode_src2 (sr, 0, d);
  316. dc = decode_dest1 (d, 0);
  317. b = get_src (sc);
  318. MATH_OP (dc, b, 0, +, > 0xff);
  319. /** 0111 110w 1110 1011 ADD.size:G #IMM,sp */
  320. dc = reg_sd (sp);
  321. imm = sign_ext (IMM(w), w?16:8);
  322. MATH_OP (dc, imm, 0, +, > 0xffff);
  323. /** 0111 1101 1011 immm ADD.size:Q #IMM,sp */
  324. dc = reg_sd (sp);
  325. imm = sign_ext (immm, 4);
  326. MATH_OP (dc, imm, 0, +, > 0xffff);
  327. /** 1111 100w immm dest ADJNZ.size #IMM,dest,label */
  328. UNARY_UOP;
  329. imm = sign_ext(immm, 4);
  330. tprintf("%x + %d = %x\n", v, imm, v+imm);
  331. v += imm;
  332. put_dest (dc, v);
  333. a = sign_ext (IMM(0), 8);
  334. if ((v & (w ? 0xffff : 0xff)) != 0)
  335. {
  336. tprintf("jmp: %x + 2 + %d = ", get_reg (pc), a);
  337. put_reg (pc, orig_pc + 2 + a);
  338. tprintf("%x\n", get_reg (pc));
  339. }
  340. /** 0111 011w 0010 dest AND.size:G #IMM,dest */
  341. UNARY_UOP;
  342. imm = IMM(w);
  343. tprintf ("%x & %x = %x\n", v, imm, v & imm);
  344. v &= imm;
  345. set_sz (v, w+1);
  346. put_dest (dc, v);
  347. /** 1001 0dst AND.B:S #IMM8,dest */
  348. imm = IMM(0);
  349. dc = decode_dest3 (dst, 0);
  350. v = get_src (dc);
  351. tprintf("%x & %x = %x\n", v, imm, v & imm);
  352. v &= imm;
  353. set_sz (v, 1);
  354. put_dest (dc, v);
  355. /** 1001 000w srcx dest AND.size:G src.dest */
  356. BINARY_UOP;
  357. tprintf ("%x & %x = %x\n", a, b, a & b);
  358. v = a & b;
  359. set_sz (v, w+1);
  360. put_dest (dc, v);
  361. /** 0001 0d sr AND.B:S src,R0L/R0H */
  362. sc = decode_src2 (sr, 0, d);
  363. dc = decode_dest1 (d, 0);
  364. a = get_src (sc);
  365. b = get_src (dc);
  366. v = a & b;
  367. tprintf("%x & %x = %x\n", a, b, v);
  368. set_sz (v, 1);
  369. put_dest (dc, v);
  370. /** 0111 1110 0100 srcx BAND src */
  371. BIT_OPC (srcx, b & carry);
  372. /** 0111 1110 1000 dest BCLR:G dest */
  373. dc = decode_bit (dest);
  374. put_bit (dc, 0);
  375. /** 0100 0bit BCLR:S bit,base:11[SB] */
  376. dc = decode_bit11 (bit);
  377. put_bit (dc, 0);
  378. /** 0111 1110 0010 dest BMcnd dest */
  379. dc = decode_bit (dest);
  380. if (condition_true (bmcnd_cond_map [IMM (0) & 15]))
  381. put_bit (dc, 1);
  382. else
  383. put_bit (dc, 0);
  384. /** 0111 1101 1101 cond BMcnd C */
  385. if (condition_true (cond))
  386. set_c (1);
  387. else
  388. set_c (0);
  389. /** 0111 1110 0101 srcx BNAND src */
  390. BIT_OPC (srcx, (!b) & carry);
  391. /** 0111 1110 0111 srcx BNOR src */
  392. BIT_OPC (srcx, (!b) | carry);
  393. /** 0111 1110 1010 dest BNOT:G dest */
  394. BIT_OP (dest, !b);
  395. /** 0101 0bit BNOT:S bit,base:11[SB] */
  396. dc = decode_bit11 (bit);
  397. put_bit (dc, !get_bit (dc));
  398. /** 0111 1110 0011 srcx BNTST src */
  399. dc = decode_bit (srcx);
  400. b = get_bit (dc);
  401. set_zc (!b, !b);
  402. /** 0111 1110 1101 srcx BNXOR src */
  403. BIT_OPC (srcx, !b ^ carry);
  404. /** 0111 1110 0110 srcx BOR src */
  405. BIT_OPC (srcx, b | carry);
  406. /** 0000 0000 BRK */
  407. /* We report the break to our caller with the PC still pointing at the
  408. breakpoint instruction. */
  409. put_reg (pc, orig_pc);
  410. if (verbose)
  411. printf("[break]\n");
  412. return M32C_MAKE_HIT_BREAK ();
  413. /** 0111 1110 1001 dest BSET:G dest */
  414. dc = decode_bit (dest);
  415. put_bit (dc, 1);
  416. /** 0100 1bit BSET:S bit,base:11[SB] */
  417. dc = decode_bit11 (bit);
  418. put_bit (dc, 1);
  419. /** 0111 1110 1011 srcx BTST:G src */
  420. dc = decode_bit (srcx);
  421. b = get_bit (dc);
  422. set_zc (!b, b);
  423. /** 0101 1bit BTST:S bit,base:11[SB] */
  424. dc = decode_bit11 (bit);
  425. b = get_bit (dc);
  426. set_zc (!b, b);
  427. /** 0111 1110 0000 dest BTSTC dest */
  428. dc = decode_bit (dest);
  429. b = get_bit (dc);
  430. set_zc (!b, b);
  431. put_bit (dc, 0);
  432. /** 0111 1110 0001 dest BTSTS dest */
  433. dc = decode_bit (dest);
  434. b = get_bit (dc);
  435. set_zc (!b, b);
  436. put_bit (dc, 1);
  437. /** 0111 1110 1100 srcx BXOR src */
  438. BIT_OPC (srcx, b ^ carry);
  439. /** 0111 011w 1000 dest CMP.size:G #IMM,dest */
  440. UNARY_UOP;
  441. imm = IMM(w);
  442. cmp (v, imm, w);
  443. /** 1101 000w immm dest CMP.size:Q #IMM,dest */
  444. UNARY_UOP;
  445. immm = sign_ext (immm, 4);
  446. cmp (v, immm, w);
  447. /** 1110 0dst CMP.B:S #IMM8,dest */
  448. imm = IMM(0);
  449. dc = decode_dest3 (dst, 0);
  450. v = get_src (dc);
  451. cmp (v, imm, 0);
  452. /** 1100 000w srcx dest CMP.size:G src,dest */
  453. BINARY_UOP;
  454. cmp(b, a, w);
  455. /** 0011 1d sr CMP.B:S src,R0L/R0H */
  456. sc = decode_src2 (sr, 0, d);
  457. dc = decode_dest1 (d, 0);
  458. a = get_src (sc);
  459. b = get_src (dc);
  460. cmp (b, a, 0);
  461. /** 0111 110w 1110 i1c s DADC,DADD,DSBB,DSUB */
  462. /* w = width, i = immediate, c = carry, s = subtract */
  463. {
  464. int src = i ? IMM(w) : get_reg (w ? r1 : r0h);
  465. int dest = get_reg (w ? r0 : r0l);
  466. int res;
  467. src = bcd2int(src, w);
  468. dest = bcd2int(dest, w);
  469. tprintf("decimal: %d %s %d", dest, s?"-":"+", src);
  470. if (c)
  471. tprintf(" c=%d", carry);
  472. if (!s)
  473. {
  474. res = dest + src;
  475. if (c)
  476. res += carry;
  477. c = res > (w ? 9999 : 99);
  478. }
  479. else
  480. {
  481. res = dest - src;
  482. if (c)
  483. res -= (1-carry);
  484. c = res >= 0;
  485. if (res < 0)
  486. res += w ? 10000 : 100;
  487. }
  488. res = int2bcd (res, w);
  489. tprintf(" = %x\n", res);
  490. set_szc (res, w+1, c);
  491. put_reg (w ? r0 : r0l, res);
  492. }
  493. /** 1010 1dst DEC.B dest */
  494. dc = decode_dest3 (dst, 0);
  495. v = get_src (dc);
  496. tprintf("%x -- = %x\n", v, v-1);
  497. v --;
  498. set_sz (v, 1);
  499. put_dest (dc, v);
  500. /** 1111 d010 DEC.W dest */
  501. v = get_reg (d ? a1 : a0);
  502. tprintf("%x -- = %x\n", v, v-1);
  503. v --;
  504. set_sz (v, 2);
  505. put_reg (d ? a1 : a0, v);
  506. /** 0111 110w 1110 0001 DIV.size #IMM */
  507. div_op (-1, 0, 0, w);
  508. /** 0111 011w 1101 srcx DIV.size src */
  509. div_op (srcx, 0, 0, w);
  510. /** 0111 110w 1110 0000 DIVU.size #IMM */
  511. div_op (-1, 1, 0, w);
  512. /** 0111 011w 1100 srcx DIVU.size src */
  513. div_op (srcx, 1, 0, w);
  514. /** 0111 110w 1110 0011 DIVX.size #IMM */
  515. div_op (-1, 0, 1, w);
  516. /** 0111 011w 1001 srcx DIVX.size src */
  517. div_op (srcx, 0, 1, w);
  518. /** 0111 1100 1111 0010 ENTER #IMM8 */
  519. imm = IMM(0);
  520. put_reg (sp, get_reg (sp) - 2);
  521. mem_put_hi (get_reg (sp), get_reg (fb));
  522. put_reg (fb, get_reg (sp));
  523. put_reg (sp, get_reg (sp) - imm);
  524. /** 0111 1101 1111 0010 EXITD */
  525. put_reg (sp, get_reg (fb));
  526. put_reg (fb, mem_get_hi (get_reg (sp)));
  527. put_reg (sp, get_reg (sp) + 2);
  528. put_reg (pc, mem_get_psi (get_reg (sp)));
  529. put_reg (sp, get_reg (sp) + 3);
  530. /** 0111 1100 0110 dest EXTS.B dest */
  531. dc = decode_srcdest4 (dest, 0);
  532. v = sign_ext (get_src (dc), 8);
  533. dc = widen_sd (dc);
  534. put_dest (dc, v);
  535. set_sz (v, 1);
  536. /** 0111 1100 1111 0011 EXTS.W R0 */
  537. v = sign_ext (get_reg (r0), 16);
  538. put_reg (r2r0, v);
  539. set_sz (v, 2);
  540. /** 1110 1011 0flg 0101 FCLR dest */
  541. set_flags (1 << flg, 0);
  542. /** 1110 1011 0flg 0100 FSET dest */
  543. set_flags (1 << flg, 1 << flg);
  544. /** 1010 0dst INC.B dest */
  545. dc = decode_dest3 (dst, 0);
  546. v = get_src (dc);
  547. tprintf("%x ++ = %x\n", v, v+1);
  548. v ++;
  549. set_sz (v, 1);
  550. put_dest (dc, v);
  551. /** 1011 d010 INC.W dest */
  552. v = get_reg (d ? a1 : a0);
  553. tprintf("%x ++ = %x\n", v, v+1);
  554. v ++;
  555. set_sz (v, 2);
  556. put_reg (d ? a1 : a0, v);
  557. /** 1110 1011 11vector INT #imm */
  558. trigger_based_interrupt (vector);
  559. /** 1111 0110 INTO */
  560. if (FLAG_O)
  561. trigger_fixed_interrupt (0xffe0);
  562. /** 0110 1cnd Jcnd label */
  563. v = sign_ext (IMM(0), 8);
  564. if (condition_true (cnd))
  565. put_reg (pc, orig_pc + 1 + v);
  566. /** 0111 1101 1100 cond Jcnd label */
  567. v = sign_ext (IMM(0), 8);
  568. if (condition_true (cond))
  569. put_reg (pc, orig_pc + 2 + v);
  570. /** 0110 0dsp JMP.S label */
  571. put_reg (pc, orig_pc + 2 + dsp);
  572. /** 1111 1110 JMP.B label */
  573. imm = sign_ext (IMM(0), 8);
  574. if (imm == -1)
  575. {
  576. if (verbose)
  577. printf("[jmp-to-self detected as exit]\n");
  578. return M32C_MAKE_HIT_BREAK ();
  579. }
  580. put_reg (pc, orig_pc + 1 + imm);
  581. /** 1111 0100 JMP.W label */
  582. imm = sign_ext (IMM(1), 16);
  583. put_reg (pc, orig_pc + 1 + imm);
  584. /** 1111 1100 JMP.A label */
  585. imm = IMM(2);
  586. put_reg (pc, imm);
  587. /** 0111 1101 0010 srcx JMPI.W src */
  588. sc = decode_jumpdest (srcx, 1);
  589. a = get_src (sc);
  590. a = sign_ext (a, 16);
  591. put_reg (pc, orig_pc + a);
  592. /** 0111 1101 0000 srcx JMPI.A src */
  593. sc = decode_jumpdest (srcx, 0);
  594. a = get_src (sc);
  595. put_reg (pc, a);
  596. /** 1110 1110 JMPS #IMM8 */
  597. M16C_ONLY();
  598. imm = IMM(0);
  599. a = 0xf0000 + mem_get_hi (0xffffe - imm * 2);
  600. put_reg (pc, a);
  601. /** 1111 0101 JSR.W label */
  602. imm = sign_ext (IMM(1), 16);
  603. put_reg (sp, get_reg (sp) - 3);
  604. mem_put_psi (get_reg (sp), get_reg (pc));
  605. put_reg (pc, orig_pc + imm + 1);
  606. /** 1111 1101 JSR.A label */
  607. imm = IMM(2);
  608. put_reg (sp, get_reg (sp) - 3);
  609. mem_put_psi (get_reg (sp), get_reg (pc));
  610. put_reg (pc, imm);
  611. /** 0111 1101 0011 srcx JSRI.W src */
  612. sc = decode_jumpdest (srcx, 1);
  613. a = get_src (sc);
  614. a = sign_ext (a, 16);
  615. put_reg (sp, get_reg (sp) - 3);
  616. mem_put_psi (get_reg (sp), get_reg (pc));
  617. put_reg (pc, orig_pc + a);
  618. /** 0111 1101 0001 srcx JSRI.A src */
  619. sc = decode_jumpdest (srcx, 0);
  620. a = get_src (sc);
  621. put_reg (sp, get_reg (sp) - 3);
  622. mem_put_psi (get_reg (sp), get_reg (pc));
  623. put_reg (pc, a);
  624. /** 1110 1111 JSRS #IMM8 */
  625. M16C_ONLY();
  626. imm = IMM(0);
  627. a = 0xf0000 + mem_get_hi (0xffffe - imm * 2);
  628. put_reg (sp, get_reg (sp) - 3);
  629. mem_put_psi (get_reg (sp), get_reg (pc));
  630. put_reg (pc, a);
  631. /** 1110 1011 0reg 0000 LDC #IMM16,dest */
  632. dc = decode_cr (reg);
  633. imm = IMM(1);
  634. put_dest (dc, imm);
  635. /** 0111 1010 1reg srcx LDC src,dest */
  636. dc = decode_cr (reg);
  637. sc = decode_srcdest4 (srcx,1);
  638. put_dest (dc, get_src (sc));
  639. /** 0111 1100 1111 0000 LDCTX abs16,abs20 */
  640. NOTYET();
  641. /** 0111 010w 1000 dest LDE.size abs20,dest */
  642. dc = decode_srcdest4 (dest, w);
  643. imm = IMM(2);
  644. if (w)
  645. v = mem_get_hi (imm);
  646. else
  647. v = mem_get_qi (imm);
  648. put_dest (dc, v);
  649. /** 0111 010w 1001 dest LDE.size dsp:20[a0], dest */
  650. dc = decode_srcdest4 (dest, w);
  651. imm = IMM(2) + get_reg (a0);
  652. if (w)
  653. v = mem_get_hi (imm);
  654. else
  655. v = mem_get_qi (imm);
  656. put_dest (dc, v);
  657. /** 0111 010w 1010 dest LDE.size [a1a0],dest */
  658. dc = decode_srcdest4 (dest, w);
  659. imm = get_reg (a1a0);
  660. if (w)
  661. v = mem_get_hi (imm);
  662. else
  663. v = mem_get_qi (imm);
  664. put_dest (dc, v);
  665. /** 0111 1101 1010 0imm LDIPL #IMM */
  666. set_flags (0x700, imm*0x100);
  667. /** 0111 010w 1100 dest MOV.size:G #IMM,dest */
  668. dc = decode_srcdest4 (dest, w);
  669. imm = IMM(w);
  670. v = imm;
  671. tprintf("%x = %x\n", v, v);
  672. set_sz(v, w+1);
  673. put_dest (dc, v);
  674. /** 1101 100w immm dest MOV.size:Q #IMM,dest */
  675. dc = decode_srcdest4 (dest, w);
  676. v = sign_ext (immm, 4);
  677. tprintf ("%x = %x\n", v, v);
  678. set_sz (v, w+1);
  679. put_dest (dc, v);
  680. /** 1100 0dst MOV.B:S #IMM8,dest */
  681. imm = IMM(0);
  682. dc = decode_dest3 (dst, 0);
  683. v = imm;
  684. tprintf("%x = %x\n", v, v);
  685. set_sz (v, 1);
  686. put_dest (dc, v);
  687. /** 1w10 d010 MOV.size:S #IMM,dest */
  688. /* Note that for w, 0=W and 1=B unlike the usual meaning. */
  689. v = IMM(1-w);
  690. tprintf("%x = %x\n", v, v);
  691. set_sz (v, 2-w);
  692. put_reg (d ? a1 : a0, v);
  693. /** 1011 0dst MOV.B:Z #0,dest */
  694. dc = decode_dest3 (dst, 0);
  695. v = 0;
  696. set_sz (v, 1);
  697. put_dest (dc, v);
  698. /** 0111 001w srcx dest MOV.size:G src,dest */
  699. sc = decode_srcdest4 (srcx, w);
  700. dc = decode_srcdest4 (dest, w);
  701. v = get_src (sc);
  702. set_sz (v, w+1);
  703. put_dest (dc, v);
  704. /** 0011 0d sr MOV.B:S src,dest */
  705. sc = decode_src2 (sr, 0, d);
  706. v = get_src (sc);
  707. set_sz (v, 1);
  708. put_reg (d ? a1 : a0, v);
  709. /** 0000 0s ds MOV.B:S R0L/R0H,dest */
  710. if (ds == 0)
  711. UNSUPPORTED();
  712. dc = decode_src2 (ds, 0, s);
  713. v = get_reg (s ? r0h : r0l);
  714. set_sz (v, 1);
  715. put_dest (dc, v);
  716. /** 0000 1d sr MOV.B:S src,R0L/R0H */
  717. sc = decode_src2 (sr, 0, d);
  718. v = get_src (sc);
  719. set_sz (v, 1);
  720. put_reg (d ? r0h : r0l, v);
  721. /** 0111 010w 1011 dest MOV.size:G dsp:8[SP], dest */
  722. dc = decode_srcdest4 (dest, w);
  723. imm = IMM(0);
  724. a = get_reg (sp) + sign_ext (imm, 8);
  725. a &= addr_mask;
  726. if (w)
  727. v = mem_get_hi (a);
  728. else
  729. v = mem_get_qi (a);
  730. set_sz (v, w+1);
  731. put_dest (dc, v);
  732. /** 0111 010w 0011 srcx MOV.size:G src, disp8[SP] */
  733. sc = decode_srcdest4 (srcx, w);
  734. imm = IMM(0);
  735. a = get_reg (sp) + sign_ext (imm, 8);
  736. a &= addr_mask;
  737. v = get_src (sc);
  738. if (w)
  739. mem_put_hi (a, v);
  740. else
  741. mem_put_qi (a, v);
  742. set_sz (v, w+1);
  743. /** 1110 1011 0reg 1src MOVA src,dest */
  744. {
  745. static reg_id map[] = { r0, r1, r2, r3, a0, a1, 0, 0 };
  746. sc = decode_srcdest4 (8 + src, 0);
  747. put_reg (map[reg], sc.u.addr);
  748. }
  749. /** 0111 1100 10hl dest MOVdir R0L,dest */
  750. if (dest == 0 || dest == 4 || dest == 5)
  751. UNSUPPORTED();
  752. dc = decode_srcdest4 (dest, 0);
  753. a = get_src (dc);
  754. b = get_reg (r0l);
  755. switch (hl)
  756. {
  757. case 0: a = (a & 0xf0) | (b & 0x0f); break;
  758. case 1: a = (a & 0xf0) | ((b>>4) & 0x0f); break;
  759. case 2: a = (a & 0x0f) | ((b & 0x0f)<<4); break;
  760. case 3: a = (a & 0x0f) | (b & 0xf0); break;
  761. }
  762. put_dest (dc, a);
  763. /** 0111 1100 00hl srcx MOVdir src,R0L */
  764. if (srcx == 0 || srcx == 4 || srcx == 5)
  765. UNSUPPORTED();
  766. sc = decode_srcdest4 (srcx, 0);
  767. a = get_reg (r0l);
  768. b = get_src (sc);
  769. switch (hl)
  770. {
  771. case 0: a = (a & 0xf0) | (b & 0x0f); break;
  772. case 1: a = (a & 0xf0) | ((b>>4) & 0x0f); break;
  773. case 2: a = (a & 0x0f) | ((b & 0x0f)<<4); break;
  774. case 3: a = (a & 0x0f) | (b & 0xf0); break;
  775. }
  776. put_reg (r0l, a);
  777. /** 0111 110w 0101 dest MUL.size #IMM,dest */
  778. UNARY_SOP;
  779. imm = sign_ext (IMM(w), w?16:8);
  780. tprintf("%d * %d = %d\n", v, imm, v*imm);
  781. v *= imm;
  782. dc = widen_sd (dc);
  783. put_dest (dc, v);
  784. /** 0111 100w srcx dest MUL.size src,dest */
  785. BINARY_SOP;
  786. v = a * b;
  787. tprintf("%d * %d = %d\n", a, b, v);
  788. dc = widen_sd (dc);
  789. put_dest (dc, v);
  790. /** 0111 110w 0100 dest MULU.size #IMM,dest */
  791. UNARY_UOP;
  792. imm = IMM(w);
  793. tprintf("%u * %u = %u\n", v, imm, v*imm);
  794. v *= imm;
  795. dc = widen_sd (dc);
  796. put_dest (dc, v);
  797. /** 0111 000w srcx dest MULU.size src,dest */
  798. BINARY_UOP;
  799. v = a * b;
  800. tprintf("%u * %u = %u\n", a, b, v);
  801. dc = widen_sd (dc);
  802. put_dest (dc, v);
  803. /** 0111 010w 0101 dest NEG.size dest */
  804. UNARY_SOP;
  805. tprintf("%d * -1 = %d\n", v, -v);
  806. v = -v;
  807. set_oszc (v, w+1, v == 0);
  808. put_dest (dc, v);
  809. /** 0000 0100 NOP */
  810. tprintf("nop\n");
  811. /** 0111 010w 0111 dest NOT.size:G */
  812. UNARY_UOP;
  813. tprintf("~ %x = %x\n", v, ~v);
  814. v = ~v;
  815. set_sz (v, w+1);
  816. put_dest (dc, v);
  817. /** 1011 1dst NOT.B:S dest */
  818. dc = decode_dest3 (dst, 0);
  819. v = get_src (dc);
  820. tprintf("~ %x = %x\n", v, ~v);
  821. v = ~v;
  822. set_sz (v, 1);
  823. put_dest (dc, v);
  824. /** 0111 011w 0011 dest OR.size:G #IMM,dest */
  825. UNARY_UOP;
  826. imm = IMM(w);
  827. tprintf ("%x | %x = %x\n", v, imm, v | imm);
  828. v |= imm;
  829. set_sz (v, w+1);
  830. put_dest (dc, v);
  831. /** 1001 1dst OR.B:S #IMM8,dest */
  832. imm = IMM(0);
  833. dc = decode_dest3 (dst, 0);
  834. v = get_src (dc);
  835. tprintf("%x | %x = %x\n", v, imm, v|imm);
  836. v |= imm;
  837. set_sz (v, 1);
  838. put_dest (dc, v);
  839. /** 1001 100w srcx dest OR.size:G src,dest */
  840. BINARY_UOP;
  841. tprintf ("%x | %x = %x\n", a, b, a | b);
  842. v = a | b;
  843. set_sz (v, w+1);
  844. put_dest (dc, v);
  845. /** 0001 1d sr OR.B:S src,R0L/R0H */
  846. sc = decode_src2 (sr, 0, d);
  847. dc = decode_dest1 (d, 0);
  848. a = get_src (sc);
  849. b = get_src (dc);
  850. v = a | b;
  851. tprintf("%x | %x = %x\n", a, b, v);
  852. set_sz (v, 1);
  853. put_dest (dc, v);
  854. /** 0111 010w 1101 dest POP.size:G dest */
  855. dc = decode_srcdest4 (dest, w);
  856. if (w)
  857. {
  858. v = mem_get_hi (get_reg (sp));
  859. put_reg (sp, get_reg (sp) + 2);
  860. tprintf("pophi: %x\n", v);
  861. }
  862. else
  863. {
  864. v = mem_get_qi (get_reg (sp));
  865. put_reg (sp, get_reg (sp) + 1);
  866. tprintf("popqi: %x\n", v);
  867. }
  868. put_dest (dc, v);
  869. /** 1001 d010 POP.B:S dest */
  870. v = mem_get_qi (get_reg (sp));
  871. put_reg (d ? r0h : r0l, v);
  872. put_reg (sp, get_reg (sp) + 1);
  873. tprintf("popqi: %x\n", v);
  874. /** 1101 d010 POP.W:S dest */
  875. v = mem_get_hi (get_reg (sp));
  876. put_reg (d ? a1 : a0, v);
  877. put_reg (sp, get_reg (sp) + 2);
  878. tprintf("pophi: %x\n", v);
  879. /** 1110 1011 0reg 0011 POPC dest */
  880. dc = decode_cr (reg);
  881. v = mem_get_hi (get_reg (sp));
  882. put_dest (dc, v);
  883. put_reg (sp, get_reg (sp) + 2);
  884. tprintf("popc: %x\n", v);
  885. /** 1110 1101 POPM dest */
  886. {
  887. static int map[] = { r0, r1, r2, r3, a0, a1, sb, fb };
  888. imm = IMM(0);
  889. tprintf("popm: %x\n", imm);
  890. for (a=0; a<8; a++)
  891. if (imm & (1<<a))
  892. {
  893. v = mem_get_hi (get_reg (sp));
  894. put_reg (map[a], v);
  895. put_reg (sp, get_reg (sp) + 2);
  896. }
  897. }
  898. /** 0111 110w 1110 0010 PUSH.size:G #IMM */
  899. imm = IMM(w);
  900. if (w)
  901. {
  902. put_reg (sp, get_reg (sp) - 2);
  903. mem_put_hi (get_reg (sp), imm);
  904. tprintf("pushhi %04x\n", imm);
  905. }
  906. else
  907. {
  908. put_reg (sp, get_reg (sp) - 1);
  909. mem_put_qi (get_reg (sp), imm);
  910. tprintf("pushqi %02x\n", imm);
  911. }
  912. /** 0111 010w 0100 srcx PUSH.size:G src */
  913. sc = decode_srcdest4 (srcx, w);
  914. v = get_src (sc);
  915. if (w)
  916. {
  917. put_reg (sp, get_reg (sp) - 2);
  918. mem_put_hi (get_reg (sp), v);
  919. tprintf("pushhi: %x\n", v);
  920. }
  921. else
  922. {
  923. put_reg (sp, get_reg (sp) - 1);
  924. mem_put_qi (get_reg (sp), v);
  925. tprintf("pushqi: %x\n", v);
  926. }
  927. /** 1000 s010 PUSH.B:S src */
  928. v = get_reg (s ? r0h : r0l);
  929. put_reg (sp, get_reg (sp) - 1);
  930. mem_put_qi (get_reg (sp), v);
  931. tprintf("pushqi: %x\n", v);
  932. /** 1100 s010 PUSH.W:S src */
  933. v = get_reg (s ? a1 : a0);
  934. put_reg (sp, get_reg (sp) - 2);
  935. mem_put_hi (get_reg (sp), v);
  936. tprintf("pushhi: %x\n", v);
  937. /** 0111 1101 1001 srcx PUSHA src */
  938. sc = decode_srcdest4 (srcx, 0);
  939. put_reg (sp, get_reg (sp) - 2);
  940. mem_put_hi (get_reg (sp), sc.u.addr);
  941. tprintf("pushhi: %x\n", sc.u.addr);
  942. /** 1110 1011 0src 0010 PUSHC src */
  943. sc = decode_cr (src);
  944. put_reg (sp, get_reg (sp) - 2);
  945. v = get_src (sc);
  946. mem_put_hi (get_reg (sp), v);
  947. tprintf("pushc: %x\n", v);
  948. /** 1110 1100 PUSHM src */
  949. {
  950. static int map[] = { fb, sb, a1, a0, r3, r2, r1, r0 };
  951. imm = IMM(0);
  952. tprintf("pushm: %x\n", imm);
  953. for (a=0; a<8; a++)
  954. if (imm & (1<<a))
  955. {
  956. put_reg (sp, get_reg (sp) - 2);
  957. v = get_reg (map[a]);
  958. mem_put_hi (get_reg (sp), v);
  959. }
  960. }
  961. /** 1111 1011 REIT */
  962. a = get_reg (sp);
  963. v = (mem_get_hi (a)
  964. + 4096 * (mem_get_qi (a+3) & 0xf0));
  965. b = (mem_get_qi (a+2)
  966. + 256 * (mem_get_qi (a+3) & 0xff));
  967. put_reg (pc, v);
  968. put_reg (flags, b);
  969. put_reg (sp, get_reg (sp) + 4);
  970. /** 0111 110w 1111 0001 RMPA.size */
  971. {
  972. int count = get_reg (r3);
  973. int list1 = get_reg (a0);
  974. int list2 = get_reg (a1);
  975. int sum = get_reg (w ? r2r0 : r0);
  976. while (count)
  977. {
  978. if (w)
  979. {
  980. a = sign_ext (mem_get_hi (list1), 16);
  981. b = sign_ext (mem_get_hi (list2), 16);
  982. }
  983. else
  984. {
  985. a = sign_ext (mem_get_qi (list1), 8);
  986. b = sign_ext (mem_get_qi (list2), 8);
  987. }
  988. tprintf("%d + %d * %d = ", sum, a, b);
  989. sum += a * b;
  990. tprintf("%d\n", sum);
  991. list1 += w ? 2 : 1;
  992. list2 += w ? 2 : 1;
  993. count --;
  994. }
  995. put_reg (r3, count);
  996. put_reg (a0, list1);
  997. put_reg (a1, list2);
  998. put_reg (w ? r2r0 : r0, sum);
  999. }
  1000. /** 0111 011w 1010 dest ROLC.size dest */
  1001. dc = decode_srcdest4 (dest, w);
  1002. rot_op (dc, 1, 1);
  1003. /** 0111 011w 1011 dest RORC.size dest */
  1004. dc = decode_srcdest4 (dest, w);
  1005. rot_op (dc, 1, -1);
  1006. /** 1110 000w immm dest ROT.size #IMM,dest */
  1007. dc = decode_srcdest4 (dest, w);
  1008. rot_op (dc, 0, IMM4());
  1009. /** 0111 010w 0110 dest ROT.size R1H,dest */
  1010. dc = decode_srcdest4 (dest, w);
  1011. rot_op (dc, 0, sign_ext (get_reg (r1h), 8));
  1012. /** 1111 0011 RTS */
  1013. put_reg (pc, mem_get_psi (get_reg (sp)));
  1014. put_reg (sp, get_reg (sp) + 3);
  1015. /** 0111 011w 0111 dest SBB.size #IMM,dest */
  1016. dc = decode_srcdest4 (dest, w);
  1017. imm = IMM(w);
  1018. MATH_OP (dc, imm, !carry, -, >= 0);
  1019. /** 1011 100w srcx dest SBB.size src,dest */
  1020. sc = decode_srcdest4(srcx, w);
  1021. dc = decode_srcdest4(dest, w);
  1022. b = get_src (sc);
  1023. MATH_OP (dc, b, !carry, -, >= 0);
  1024. /** 1111 000w immm dest SHA.size #IMM, dest */
  1025. dc = decode_srcdest4(dest, w);
  1026. shift_op (dc, 1, IMM4());
  1027. /** 0111 010w 1111 dest SHA.size R1H,dest */
  1028. dc = decode_srcdest4(dest, w);
  1029. a = sign_ext (get_reg (r1h), 8);
  1030. shift_op (dc, 1, a);
  1031. /** 1110 1011 101d immm SHA.L #IMM, dest */
  1032. dc = reg_sd (d ? r3r1 : r2r0);
  1033. shift_op (dc, 1, IMM4());
  1034. /** 1110 1011 001d 0001 SHA.L R1H,dest */
  1035. dc = reg_sd (d ? r3r1 : r2r0);
  1036. a = sign_ext (get_reg (r1h), 8);
  1037. shift_op (dc, 1, a);
  1038. /** 1110 100w immm dest SHL.size #IMM, dest */
  1039. dc = decode_srcdest4(dest, w);
  1040. shift_op (dc, 0, IMM4());
  1041. /** 0111 010w 1110 dest SHL.size R1H,dest */
  1042. dc = decode_srcdest4(dest, w);
  1043. a = sign_ext (get_reg (r1h), 8);
  1044. shift_op (dc, 0, a);
  1045. /** 1110 1011 100d immm SHL.L #IMM,dest */
  1046. dc = reg_sd (d ? r3r1 : r2r0);
  1047. shift_op (dc, 0, IMM4());
  1048. /** 1110 1011 000d 0001 SHL.L R1H,dest */
  1049. dc = reg_sd (d ? r3r1 : r2r0);
  1050. a = sign_ext (get_reg (r1h), 8);
  1051. shift_op (dc, 0, a);
  1052. /** 0111 110w 1110 100b SMOVB.size */
  1053. {
  1054. int count = get_reg (r3);
  1055. int s1 = get_reg (a0) + (get_reg (r1h) << 16);
  1056. int s2 = get_reg (a1);
  1057. int inc = (w ? 2 : 1) * (b ? -1 : 1);
  1058. while (count)
  1059. {
  1060. if (w)
  1061. {
  1062. v = mem_get_hi (s1);
  1063. mem_put_hi (s2, v);
  1064. }
  1065. else
  1066. {
  1067. v = mem_get_qi (s1);
  1068. mem_put_qi (s2, v);
  1069. }
  1070. s1 += inc;
  1071. s2 += inc;
  1072. count --;
  1073. }
  1074. put_reg (r3, count);
  1075. put_reg (a0, s1 & 0xffff);
  1076. put_reg (a1, s2);
  1077. put_reg (r1h, s1 >> 16);
  1078. }
  1079. /** 0111 110w 1110 1010 SSTR.size */
  1080. {
  1081. int count = get_reg (r3);
  1082. int s1 = get_reg (a1);
  1083. v = get_reg (w ? r0 : r0l);
  1084. while (count)
  1085. {
  1086. if (w)
  1087. {
  1088. mem_put_hi (s1, v);
  1089. s1 += 2;
  1090. }
  1091. else
  1092. {
  1093. mem_put_qi (s1, v);
  1094. s1 += 1;
  1095. }
  1096. count --;
  1097. }
  1098. put_reg (r3, count);
  1099. put_reg (a1, s1);
  1100. }
  1101. /** 0111 1011 1src dest STC src,dest */
  1102. dc = decode_srcdest4 (dest, 1);
  1103. sc = decode_cr (src);
  1104. put_dest (dc, get_src(sc));
  1105. /** 0111 1100 1100 dest STC PC,dest */
  1106. dc = decode_srcdest4 (dest, 1);
  1107. dc.bytes = 3;
  1108. put_dest (dc, orig_pc);
  1109. /** 0111 1101 1111 0000 STCTX abs16,abs20 */
  1110. NOTYET();
  1111. /** 0111 010w 0000 srcx STE.size src,abs20 */
  1112. sc = decode_srcdest4 (srcx, w);
  1113. a = IMM(2);
  1114. v = get_src (sc);
  1115. if (w)
  1116. mem_put_hi (a, v);
  1117. else
  1118. mem_put_qi (a, v);
  1119. if (srcx == 4 || srcx == 5)
  1120. {
  1121. v = get_reg (sc.u.reg);
  1122. set_sz (v, 2);
  1123. }
  1124. else
  1125. set_sz (v, w+1);
  1126. /** 0111 010w 0001 srcx STE.size src,disp20[a0] */
  1127. sc = decode_srcdest4 (srcx, w);
  1128. a = get_reg(a0) + IMM(2);
  1129. v = get_src (sc);
  1130. if (w)
  1131. mem_put_hi (a, v);
  1132. else
  1133. mem_put_qi (a, v);
  1134. if (srcx == 4 || srcx == 5)
  1135. {
  1136. v = get_reg (sc.u.reg);
  1137. set_sz (v, 2);
  1138. }
  1139. else
  1140. set_sz (v, w+1);
  1141. /** 0111 010w 0010 srcx STE.size src,[a1a0] */
  1142. sc = decode_srcdest4 (srcx, w);
  1143. a = get_reg(a1a0);
  1144. v = get_src (sc);
  1145. if (w)
  1146. mem_put_hi (a, v);
  1147. else
  1148. mem_put_qi (a, v);
  1149. if (srcx == 4 || srcx == 5)
  1150. {
  1151. v = get_reg (sc.u.reg);
  1152. set_sz (v, 2);
  1153. }
  1154. else
  1155. set_sz (v, w+1);
  1156. /** 1101 0dst STNZ #IMM8,dest */
  1157. imm = IMM(0);
  1158. dc = decode_dest3(dst, 0);
  1159. if (!FLAG_Z)
  1160. put_dest (dc, imm);
  1161. /** 1100 1dst STZ #IMM8,dest */
  1162. imm = IMM(0);
  1163. dc = decode_dest3(dst, 0);
  1164. if (FLAG_Z)
  1165. put_dest (dc, imm);
  1166. /** 1101 1dst STZX #IMM81,#IMM82,dest */
  1167. a = IMM(0);
  1168. dc = decode_dest3(dst, 0);
  1169. b = IMM(0);
  1170. if (FLAG_Z)
  1171. put_dest (dc, a);
  1172. else
  1173. put_dest (dc, b);
  1174. /** 0111 011w 0101 dest SUB.size:G #IMM,dest */
  1175. dc = decode_srcdest4 (dest, w);
  1176. imm = IMM(w);
  1177. MATH_OP (dc, imm, 0, -, >= 0);
  1178. /** 1000 1dst SUB.B:S #IMM8,dest */
  1179. imm = IMM(0);
  1180. dc = decode_dest3 (dst, 0);
  1181. MATH_OP (dc, imm, 0, -, >= 0);
  1182. /** 1010 100w srcx dest SUB.size:G src,dest */
  1183. sc = decode_srcdest4(srcx, w);
  1184. dc = decode_srcdest4(dest, w);
  1185. b = get_src (sc);
  1186. MATH_OP (dc, b, 0, -, >= 0);
  1187. /** 0010 1d sr SUB.B:S src,R0L/R0H */
  1188. sc = decode_src2 (sr, 0, d);
  1189. dc = decode_dest1 (d, 0);
  1190. b = get_src (sc);
  1191. MATH_OP (dc, b, 0, -, >= 0);
  1192. /** 0111 011w 0000 dest TST.size #IMM, dest */
  1193. UNARY_UOP;
  1194. imm = IMM(w);
  1195. tprintf ("%x & %x = %x\n", v, imm, v & imm);
  1196. v &= imm;
  1197. set_sz (v, w+1);
  1198. /** 1000 000w srcx dest TST.size src,dest */
  1199. BINARY_UOP;
  1200. tprintf ("%x & %x = %x\n", a, b, a & b);
  1201. v = a & b;
  1202. set_sz (v, w+1);
  1203. /** 1111 1111 UND */
  1204. trigger_fixed_interrupt (0xffdc);
  1205. /** 0111 1101 1111 0011 WAIT */
  1206. tprintf("waiting...\n");
  1207. /** 0111 101w 00sr dest XCHG.size src,dest */
  1208. sc = decode_srcdest4 (sr, w);
  1209. dc = decode_srcdest4 (dest, w);
  1210. a = get_src (sc);
  1211. b = get_src (dc);
  1212. put_dest (dc, a);
  1213. put_dest (sc, b);
  1214. /** 0111 011w 0001 dest XOR.size #IMM,dest */
  1215. UNARY_UOP;
  1216. imm = IMM(w);
  1217. tprintf ("%x ^ %x = %x\n", v, imm, v ^ imm);
  1218. v ^= imm;
  1219. set_sz (v, w+1);
  1220. put_dest (dc, v);
  1221. /** 1000 100w srcx dest XOR.size src,dest */
  1222. BINARY_UOP;
  1223. tprintf ("%x ^ %x = %x\n", a, b, a ^ b);
  1224. v = a ^ b;
  1225. set_sz (v, w+1);
  1226. put_dest (dc, v);
  1227. /** OP */
  1228. /** */
  1229. return step_result;
  1230. }