SD card emulation (initial implementation by Andrzei Zaborowski).
[qemu/mini2440.git] / target-sh4 / op.c
blobd3b68bc665229fac9d8c3f08e7560ff9625e39e6
1 /*
2 * SH4 emulation
3 *
4 * Copyright (c) 2005 Samuel Tardieu
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 #include "exec.h"
22 static inline void set_flag(uint32_t flag)
24 env->flags |= flag;
27 static inline void clr_flag(uint32_t flag)
29 env->flags &= ~flag;
32 static inline void set_t(void)
34 env->sr |= SR_T;
37 static inline void clr_t(void)
39 env->sr &= ~SR_T;
42 static inline void cond_t(int cond)
44 if (cond)
45 set_t();
46 else
47 clr_t();
50 void OPPROTO op_movl_imm_T0(void)
52 T0 = (uint32_t) PARAM1;
53 RETURN();
56 void OPPROTO op_movl_imm_T1(void)
58 T0 = (uint32_t) PARAM1;
59 RETURN();
62 void OPPROTO op_movl_imm_T2(void)
64 T0 = (uint32_t) PARAM1;
65 RETURN();
68 void OPPROTO op_cmp_eq_imm_T0(void)
70 cond_t((int32_t) T0 == (int32_t) PARAM1);
71 RETURN();
74 void OPPROTO op_cmd_eq_T0_T1(void)
76 cond_t(T0 == T1);
77 RETURN();
80 void OPPROTO op_cmd_hs_T0_T1(void)
82 cond_t((uint32_t) T0 <= (uint32_t) T1);
83 RETURN();
86 void OPPROTO op_cmd_ge_T0_T1(void)
88 cond_t((int32_t) T0 <= (int32_t) T1);
89 RETURN();
92 void OPPROTO op_cmd_hi_T0_T1(void)
94 cond_t((uint32_t) T0 < (uint32_t) T1);
95 RETURN();
98 void OPPROTO op_cmd_gt_T0_T1(void)
100 cond_t((int32_t) T0 < (int32_t) T1);
101 RETURN();
104 void OPPROTO op_not_T0(void)
106 T0 = ~T0;
107 RETURN();
110 void OPPROTO op_bf_s(void)
112 env->delayed_pc = PARAM1;
113 set_flag(DELAY_SLOT_CONDITIONAL | ((~env->sr) & SR_T));
114 RETURN();
117 void OPPROTO op_bt_s(void)
119 env->delayed_pc = PARAM1;
120 set_flag(DELAY_SLOT_CONDITIONAL | (env->sr & SR_T));
121 RETURN();
124 void OPPROTO op_bra(void)
126 env->delayed_pc = PARAM1;
127 set_flag(DELAY_SLOT);
128 RETURN();
131 void OPPROTO op_braf_T0(void)
133 env->delayed_pc = PARAM1 + T0;
134 set_flag(DELAY_SLOT);
135 RETURN();
138 void OPPROTO op_bsr(void)
140 env->pr = PARAM1;
141 env->delayed_pc = PARAM2;
142 set_flag(DELAY_SLOT);
143 RETURN();
146 void OPPROTO op_bsrf_T0(void)
148 env->pr = PARAM1;
149 env->delayed_pc = PARAM1 + T0;
150 set_flag(DELAY_SLOT);
151 RETURN();
154 void OPPROTO op_jsr_T0(void)
156 env->pr = PARAM1;
157 env->delayed_pc = T0;
158 set_flag(DELAY_SLOT);
159 RETURN();
162 void OPPROTO op_rts(void)
164 env->delayed_pc = env->pr;
165 set_flag(DELAY_SLOT);
166 RETURN();
169 void OPPROTO op_clr_delay_slot(void)
171 clr_flag(DELAY_SLOT);
172 RETURN();
175 void OPPROTO op_clr_delay_slot_conditional(void)
177 clr_flag(DELAY_SLOT_CONDITIONAL);
178 RETURN();
181 void OPPROTO op_exit_tb(void)
183 EXIT_TB();
184 RETURN();
187 void OPPROTO op_addl_imm_T0(void)
189 T0 += PARAM1;
190 RETURN();
193 void OPPROTO op_addl_imm_T1(void)
195 T1 += PARAM1;
196 RETURN();
199 void OPPROTO op_clrmac(void)
201 env->mach = env->macl = 0;
202 RETURN();
205 void OPPROTO op_clrs(void)
207 env->sr &= ~SR_S;
208 RETURN();
211 void OPPROTO op_clrt(void)
213 env->sr &= ~SR_T;
214 RETURN();
217 void OPPROTO op_sets(void)
219 env->sr |= SR_S;
220 RETURN();
223 void OPPROTO op_sett(void)
225 env->sr |= SR_T;
226 RETURN();
229 void OPPROTO op_frchg(void)
231 env->fpscr ^= FPSCR_FR;
232 RETURN();
235 void OPPROTO op_fschg(void)
237 env->fpscr ^= FPSCR_SZ;
238 RETURN();
241 void OPPROTO op_rte(void)
243 env->sr = env->ssr;
244 env->delayed_pc = env->spc;
245 set_flag(DELAY_SLOT);
246 RETURN();
249 void OPPROTO op_swapb_T0(void)
251 T0 = (T0 & 0xffff0000) | ((T0 & 0xff) << 8) | ((T0 >> 8) & 0xff);
252 RETURN();
255 void OPPROTO op_swapw_T0(void)
257 T0 = ((T0 & 0xffff) << 16) | ((T0 >> 16) & 0xffff);
258 RETURN();
261 void OPPROTO op_xtrct_T0_T1(void)
263 T1 = ((T0 & 0xffff) << 16) | ((T1 >> 16) & 0xffff);
264 RETURN();
267 void OPPROTO op_addc_T0_T1(void)
269 helper_addc_T0_T1();
270 RETURN();
273 void OPPROTO op_addv_T0_T1(void)
275 helper_addv_T0_T1();
276 RETURN();
279 void OPPROTO op_cmp_eq_T0_T1(void)
281 cond_t(T1 == T0);
282 RETURN();
285 void OPPROTO op_cmp_ge_T0_T1(void)
287 cond_t((int32_t) T1 >= (int32_t) T0);
288 RETURN();
291 void OPPROTO op_cmp_gt_T0_T1(void)
293 cond_t((int32_t) T1 > (int32_t) T0);
294 RETURN();
297 void OPPROTO op_cmp_hi_T0_T1(void)
299 cond_t((uint32_t) T1 > (uint32_t) T0);
300 RETURN();
303 void OPPROTO op_cmp_hs_T0_T1(void)
305 cond_t((uint32_t) T1 >= (uint32_t) T0);
306 RETURN();
309 void OPPROTO op_cmp_str_T0_T1(void)
311 cond_t((T0 & 0x000000ff) == (T1 & 0x000000ff) ||
312 (T0 & 0x0000ff00) == (T1 & 0x0000ff00) ||
313 (T0 & 0x00ff0000) == (T1 & 0x00ff0000) ||
314 (T0 & 0xff000000) == (T1 & 0xff000000));
315 RETURN();
318 void OPPROTO op_tst_T0_T1(void)
320 cond_t((T1 & T0) == 0);
321 RETURN();
324 void OPPROTO op_div0s_T0_T1(void)
326 if (T1 & 0x80000000)
327 env->sr |= SR_Q;
328 else
329 env->sr &= ~SR_Q;
330 if (T0 & 0x80000000)
331 env->sr |= SR_M;
332 else
333 env->sr &= ~SR_M;
334 cond_t((T1 ^ T0) & 0x80000000);
335 RETURN();
338 void OPPROTO op_div0u(void)
340 env->sr &= ~(SR_M | SR_Q | SR_T);
341 RETURN();
344 void OPPROTO op_div1_T0_T1(void)
346 helper_div1_T0_T1();
347 RETURN();
350 void OPPROTO op_dmulsl_T0_T1(void)
352 helper_dmulsl_T0_T1();
353 RETURN();
356 void OPPROTO op_dmulul_T0_T1(void)
358 helper_dmulul_T0_T1();
359 RETURN();
362 void OPPROTO op_macl_T0_T1(void)
364 helper_macl_T0_T1();
365 RETURN();
368 void OPPROTO op_macw_T0_T1(void)
370 helper_macw_T0_T1();
371 RETURN();
374 void OPPROTO op_mull_T0_T1(void)
376 env->macl = (T0 * T1) & 0xffffffff;
377 RETURN();
380 void OPPROTO op_mulsw_T0_T1(void)
382 env->macl = (int32_t) T0 *(int32_t) T1;
383 RETURN();
386 void OPPROTO op_muluw_T0_T1(void)
388 env->macl = (uint32_t) T0 *(uint32_t) T1;
389 RETURN();
392 void OPPROTO op_neg_T0(void)
394 T0 = -T0;
395 RETURN();
398 void OPPROTO op_negc_T0(void)
400 helper_negc_T0();
401 RETURN();
404 void OPPROTO op_shad_T0_T1(void)
406 if ((T0 & 0x80000000) == 0)
407 T1 <<= (T0 & 0x1f);
408 else if ((T0 & 0x1f) == 0)
409 T1 = 0;
410 else
411 T1 = ((int32_t) T1) >> ((~T0 & 0x1f) + 1);
412 RETURN();
415 void OPPROTO op_shld_T0_T1(void)
417 if ((T0 & 0x80000000) == 0)
418 T1 <<= (T0 & 0x1f);
419 else if ((T0 & 0x1f) == 0)
420 T1 = 0;
421 else
422 T1 = ((uint32_t) T1) >> ((~T0 & 0x1f) + 1);
423 RETURN();
426 void OPPROTO op_subc_T0_T1(void)
428 helper_subc_T0_T1();
429 RETURN();
432 void OPPROTO op_subv_T0_T1(void)
434 helper_subv_T0_T1();
435 RETURN();
438 void OPPROTO op_trapa(void)
440 env->tra = PARAM1 * 2;
441 env->exception_index = 0x160;
442 do_raise_exception();
443 RETURN();
446 void OPPROTO op_cmp_pl_T0(void)
448 cond_t((int32_t) T0 > 0);
449 RETURN();
452 void OPPROTO op_cmp_pz_T0(void)
454 cond_t((int32_t) T0 >= 0);
455 RETURN();
458 void OPPROTO op_jmp_T0(void)
460 env->delayed_pc = T0;
461 set_flag(DELAY_SLOT);
462 RETURN();
465 void OPPROTO op_movl_rN_rN(void)
467 env->gregs[PARAM2] = env->gregs[PARAM1];
468 RETURN();
471 void OPPROTO op_ldcl_rMplus_rN_bank(void)
473 env->gregs[PARAM2] = env->gregs[PARAM1];
474 env->gregs[PARAM1] += 4;
475 RETURN();
478 void OPPROTO op_ldc_T0_sr(void)
480 env->sr = T0 & 0x700083f3;
481 RETURN();
484 void OPPROTO op_stc_sr_T0(void)
486 T0 = env->sr;
487 RETURN();
490 #define LDSTOPS(target,load,store) \
491 void OPPROTO op_##load##_T0_##target (void) \
492 { env ->target = T0; RETURN(); \
494 void OPPROTO op_##store##_##target##_T0 (void) \
495 { T0 = env->target; RETURN(); \
498 LDSTOPS(gbr, ldc, stc)
499 LDSTOPS(vbr, ldc, stc)
500 LDSTOPS(ssr, ldc, stc)
501 LDSTOPS(spc, ldc, stc)
502 LDSTOPS(sgr, ldc, stc)
503 LDSTOPS(dbr, ldc, stc)
504 LDSTOPS(mach, lds, sts)
505 LDSTOPS(macl, lds, sts)
506 LDSTOPS(pr, lds, sts)
507 LDSTOPS(fpul, lds, sts)
509 void OPPROTO op_lds_T0_fpscr(void)
511 env->fpscr = T0 & 0x003fffff;
512 RETURN();
515 void OPPROTO op_sts_fpscr_T0(void)
517 T0 = env->fpscr & 0x003fffff;
518 RETURN();
521 void OPPROTO op_movt_rN(void)
523 env->gregs[PARAM1] = env->sr & SR_T;
524 RETURN();
527 void OPPROTO op_rotcl_Rn(void)
529 helper_rotcl(&env->gregs[PARAM1]);
530 RETURN();
533 void OPPROTO op_rotcr_Rn(void)
535 helper_rotcr(&env->gregs[PARAM1]);
536 RETURN();
539 void OPPROTO op_rotl_Rn(void)
541 cond_t(env->gregs[PARAM1] & 0x80000000);
542 env->gregs[PARAM1] = (env->gregs[PARAM1] << 1) | (env->sr & SR_T);
543 RETURN();
546 void OPPROTO op_rotr_Rn(void)
548 cond_t(env->gregs[PARAM1] & 1);
549 env->gregs[PARAM1] = (env->gregs[PARAM1] >> 1) |
550 ((env->sr & SR_T) ? 0x80000000 : 0);
551 RETURN();
554 void OPPROTO op_shal_Rn(void)
556 cond_t(env->gregs[PARAM1] & 0x80000000);
557 env->gregs[PARAM1] <<= 1;
558 RETURN();
561 void OPPROTO op_shar_Rn(void)
563 cond_t(env->gregs[PARAM1] & 1);
564 *(int32_t *) & env->gregs[PARAM1] >>= 1;
565 RETURN();
568 void OPPROTO op_shlr_Rn(void)
570 cond_t(env->gregs[PARAM1] & 1);
571 *(uint32_t *) & env->gregs[PARAM1] >>= 1;
572 RETURN();
575 void OPPROTO op_shll2_Rn(void)
577 env->gregs[PARAM1] <<= 2;
578 RETURN();
581 void OPPROTO op_shll8_Rn(void)
583 env->gregs[PARAM1] <<= 8;
584 RETURN();
587 void OPPROTO op_shll16_Rn(void)
589 env->gregs[PARAM1] <<= 16;
590 RETURN();
593 void OPPROTO op_shlr2_Rn(void)
595 *(uint32_t *) & env->gregs[PARAM1] >>= 2;
596 RETURN();
599 void OPPROTO op_shlr8_Rn(void)
601 *(uint32_t *) & env->gregs[PARAM1] >>= 8;
602 RETURN();
605 void OPPROTO op_shlr16_Rn(void)
607 *(uint32_t *) & env->gregs[PARAM1] >>= 16;
608 RETURN();
611 void OPPROTO op_tasb_rN(void)
613 cond_t(*(int8_t *) env->gregs[PARAM1] == 0);
614 *(int8_t *) env->gregs[PARAM1] |= 0x80;
615 RETURN();
618 void OPPROTO op_movl_T0_rN(void)
620 env->gregs[PARAM1] = T0;
621 RETURN();
624 void OPPROTO op_movl_T1_rN(void)
626 env->gregs[PARAM1] = T1;
627 RETURN();
630 void OPPROTO op_movb_rN_T0(void)
632 T0 = (int32_t) (int8_t) (env->gregs[PARAM1] & 0xff);
633 RETURN();
636 void OPPROTO op_movub_rN_T0(void)
638 T0 = env->gregs[PARAM1] & 0xff;
639 RETURN();
642 void OPPROTO op_movw_rN_T0(void)
644 T0 = (int32_t) (int16_t) (env->gregs[PARAM1] & 0xffff);
645 RETURN();
648 void OPPROTO op_movuw_rN_T0(void)
650 T0 = env->gregs[PARAM1] & 0xffff;
651 RETURN();
654 void OPPROTO op_movl_rN_T0(void)
656 T0 = env->gregs[PARAM1];
657 RETURN();
660 void OPPROTO op_movb_rN_T1(void)
662 T1 = (int32_t) (int8_t) (env->gregs[PARAM1] & 0xff);
663 RETURN();
666 void OPPROTO op_movub_rN_T1(void)
668 T1 = env->gregs[PARAM1] & 0xff;
669 RETURN();
672 void OPPROTO op_movw_rN_T1(void)
674 T1 = (int32_t) (int16_t) (env->gregs[PARAM1] & 0xffff);
675 RETURN();
678 void OPPROTO op_movuw_rN_T1(void)
680 T1 = env->gregs[PARAM1] & 0xffff;
681 RETURN();
684 void OPPROTO op_movl_rN_T1(void)
686 T1 = env->gregs[PARAM1];
687 RETURN();
690 void OPPROTO op_movl_imm_rN(void)
692 env->gregs[PARAM2] = PARAM1;
693 RETURN();
696 void OPPROTO op_fmov_frN_FT0(void)
698 FT0 = *(float32 *)&env->fregs[PARAM1];
699 RETURN();
702 void OPPROTO op_fmov_drN_DT0(void)
704 DT0 = *(float64 *)&env->fregs[PARAM1];
705 RETURN();
708 void OPPROTO op_fmov_FT0_frN(void)
710 *(float32 *)&env->fregs[PARAM1] = FT0;
711 RETURN();
714 void OPPROTO op_fmov_DT0_drN(void)
716 *(float64 *)&env->fregs[PARAM1] = DT0;
717 RETURN();
720 void OPPROTO op_dec1_rN(void)
722 env->gregs[PARAM1] -= 1;
723 RETURN();
726 void OPPROTO op_dec2_rN(void)
728 env->gregs[PARAM1] -= 2;
729 RETURN();
732 void OPPROTO op_dec4_rN(void)
734 env->gregs[PARAM1] -= 4;
735 RETURN();
738 void OPPROTO op_dec8_rN(void)
740 env->gregs[PARAM1] -= 4;
741 RETURN();
744 void OPPROTO op_inc1_rN(void)
746 env->gregs[PARAM1] += 1;
747 RETURN();
750 void OPPROTO op_inc2_rN(void)
752 env->gregs[PARAM1] += 2;
753 RETURN();
756 void OPPROTO op_inc4_rN(void)
758 env->gregs[PARAM1] += 4;
759 RETURN();
762 void OPPROTO op_inc8_rN(void)
764 env->gregs[PARAM1] += 4;
765 RETURN();
768 void OPPROTO op_add_T0_rN(void)
770 env->gregs[PARAM1] += T0;
771 RETURN();
774 void OPPROTO op_sub_T0_rN(void)
776 env->gregs[PARAM1] -= T0;
777 RETURN();
780 void OPPROTO op_and_T0_rN(void)
782 env->gregs[PARAM1] &= T0;
783 RETURN();
786 void OPPROTO op_or_T0_rN(void)
788 env->gregs[PARAM1] |= T0;
789 RETURN();
792 void OPPROTO op_xor_T0_rN(void)
794 env->gregs[PARAM1] ^= T0;
795 RETURN();
798 void OPPROTO op_add_rN_T0(void)
800 T0 += env->gregs[PARAM1];
801 RETURN();
804 void OPPROTO op_add_rN_T1(void)
806 T1 += env->gregs[PARAM1];
807 RETURN();
810 void OPPROTO op_add_imm_rN(void)
812 env->gregs[PARAM2] += PARAM1;
813 RETURN();
816 void OPPROTO op_and_imm_rN(void)
818 env->gregs[PARAM2] &= PARAM1;
819 RETURN();
822 void OPPROTO op_or_imm_rN(void)
824 env->gregs[PARAM2] |= PARAM1;
825 RETURN();
828 void OPPROTO op_xor_imm_rN(void)
830 env->gregs[PARAM2] ^= PARAM1;
831 RETURN();
834 void OPPROTO op_dt_rN(void)
836 cond_t((--env->gregs[PARAM1]) == 0);
837 RETURN();
840 void OPPROTO op_tst_imm_rN(void)
842 cond_t((env->gregs[PARAM2] & PARAM1) == 0);
843 RETURN();
846 void OPPROTO op_movl_T0_T1(void)
848 T1 = T0;
849 RETURN();
852 void OPPROTO op_movl_fpul_FT0(void)
854 FT0 = *(float32 *)&env->fpul;
855 RETURN();
858 void OPPROTO op_movl_FT0_fpul(void)
860 *(float32 *)&env->fpul = FT0;
861 RETURN();
864 void OPPROTO op_goto_tb0(void)
866 GOTO_TB(op_goto_tb0, PARAM1, 0);
867 RETURN();
870 void OPPROTO op_goto_tb1(void)
872 GOTO_TB(op_goto_tb1, PARAM1, 1);
873 RETURN();
876 void OPPROTO op_movl_imm_PC(void)
878 env->pc = PARAM1;
879 RETURN();
882 void OPPROTO op_jT(void)
884 if (env->sr & SR_T)
885 GOTO_LABEL_PARAM(1);
886 RETURN();
889 void OPPROTO op_jdelayed(void)
891 uint32_t flags;
892 flags = env->flags;
893 env->flags &= ~(DELAY_SLOT | DELAY_SLOT_CONDITIONAL);
894 if (flags & DELAY_SLOT)
895 GOTO_LABEL_PARAM(1);
896 RETURN();
899 void OPPROTO op_movl_delayed_pc_PC(void)
901 env->pc = env->delayed_pc;
902 RETURN();
905 void OPPROTO op_addl_GBR_T0(void)
907 T0 += env->gbr;
908 RETURN();
911 void OPPROTO op_and_imm_T0(void)
913 T0 &= PARAM1;
914 RETURN();
917 void OPPROTO op_or_imm_T0(void)
919 T0 |= PARAM1;
920 RETURN();
923 void OPPROTO op_xor_imm_T0(void)
925 T0 ^= PARAM1;
926 RETURN();
929 void OPPROTO op_tst_imm_T0(void)
931 cond_t((T0 & PARAM1) == 0);
932 RETURN();
935 void OPPROTO op_raise_illegal_instruction(void)
937 env->exception_index = 0x180;
938 do_raise_exception();
939 RETURN();
942 void OPPROTO op_raise_slot_illegal_instruction(void)
944 env->exception_index = 0x1a0;
945 do_raise_exception();
946 RETURN();
949 void OPPROTO op_debug(void)
951 env->exception_index = EXCP_DEBUG;
952 cpu_loop_exit();
955 /* Load and store */
956 #define MEMSUFFIX _raw
957 #include "op_mem.c"
958 #undef MEMSUFFIX
959 #if !defined(CONFIG_USER_ONLY)
960 #define MEMSUFFIX _user
961 #include "op_mem.c"
962 #undef MEMSUFFIX
964 #define MEMSUFFIX _kernel
965 #include "op_mem.c"
966 #undef MEMSUFFIX
967 #endif