Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 1 | /* |
| 2 | * This file is subject to the terms and conditions of the GNU General Public |
| 3 | * License. See the file "COPYING" in the main directory of this archive |
| 4 | * for more details. |
| 5 | * |
| 6 | * Copyright (C) 2004, 2005, 2006, 2008 Thiemo Seufer |
| 7 | * Copyright (C) 2005 Maciej W. Rozycki |
| 8 | * Copyright (C) 2006 Ralf Baechle (ralf@linux-mips.org) |
| 9 | */ |
| 10 | |
| 11 | #include <linux/types.h> |
| 12 | |
| 13 | #define Ip_u1u2u3(op) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 14 | void __cpuinit \ |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 15 | uasm_i##op(u32 **buf, unsigned int a, unsigned int b, unsigned int c) |
| 16 | |
| 17 | #define Ip_u2u1u3(op) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 18 | void __cpuinit \ |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 19 | uasm_i##op(u32 **buf, unsigned int a, unsigned int b, unsigned int c) |
| 20 | |
| 21 | #define Ip_u3u1u2(op) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 22 | void __cpuinit \ |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 23 | uasm_i##op(u32 **buf, unsigned int a, unsigned int b, unsigned int c) |
| 24 | |
| 25 | #define Ip_u1u2s3(op) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 26 | void __cpuinit \ |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 27 | uasm_i##op(u32 **buf, unsigned int a, unsigned int b, signed int c) |
| 28 | |
| 29 | #define Ip_u2s3u1(op) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 30 | void __cpuinit \ |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 31 | uasm_i##op(u32 **buf, unsigned int a, signed int b, unsigned int c) |
| 32 | |
| 33 | #define Ip_u2u1s3(op) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 34 | void __cpuinit \ |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 35 | uasm_i##op(u32 **buf, unsigned int a, unsigned int b, signed int c) |
| 36 | |
David Daney | 92078e0 | 2009-10-14 12:16:55 -0700 | [diff] [blame] | 37 | #define Ip_u2u1msbu3(op) \ |
| 38 | void __cpuinit \ |
| 39 | uasm_i##op(u32 **buf, unsigned int a, unsigned int b, unsigned int c, \ |
| 40 | unsigned int d) |
| 41 | |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 42 | #define Ip_u1u2(op) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 43 | void __cpuinit uasm_i##op(u32 **buf, unsigned int a, unsigned int b) |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 44 | |
| 45 | #define Ip_u1s2(op) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 46 | void __cpuinit uasm_i##op(u32 **buf, unsigned int a, signed int b) |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 47 | |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 48 | #define Ip_u1(op) void __cpuinit uasm_i##op(u32 **buf, unsigned int a) |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 49 | |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 50 | #define Ip_0(op) void __cpuinit uasm_i##op(u32 **buf) |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 51 | |
| 52 | Ip_u2u1s3(_addiu); |
| 53 | Ip_u3u1u2(_addu); |
| 54 | Ip_u2u1u3(_andi); |
| 55 | Ip_u3u1u2(_and); |
| 56 | Ip_u1u2s3(_beq); |
| 57 | Ip_u1u2s3(_beql); |
| 58 | Ip_u1s2(_bgez); |
| 59 | Ip_u1s2(_bgezl); |
| 60 | Ip_u1s2(_bltz); |
| 61 | Ip_u1s2(_bltzl); |
| 62 | Ip_u1u2s3(_bne); |
Thiemo Seufer | fb2a27e7 | 2008-02-18 19:32:49 +0000 | [diff] [blame] | 63 | Ip_u2s3u1(_cache); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 64 | Ip_u1u2u3(_dmfc0); |
| 65 | Ip_u1u2u3(_dmtc0); |
| 66 | Ip_u2u1s3(_daddiu); |
| 67 | Ip_u3u1u2(_daddu); |
| 68 | Ip_u2u1u3(_dsll); |
| 69 | Ip_u2u1u3(_dsll32); |
| 70 | Ip_u2u1u3(_dsra); |
| 71 | Ip_u2u1u3(_dsrl); |
| 72 | Ip_u2u1u3(_dsrl32); |
David Daney | 92078e0 | 2009-10-14 12:16:55 -0700 | [diff] [blame] | 73 | Ip_u2u1u3(_drotr); |
David Daney | de6d5b55 | 2010-07-23 18:41:41 -0700 | [diff] [blame] | 74 | Ip_u2u1u3(_drotr32); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 75 | Ip_u3u1u2(_dsubu); |
| 76 | Ip_0(_eret); |
| 77 | Ip_u1(_j); |
| 78 | Ip_u1(_jal); |
| 79 | Ip_u1(_jr); |
| 80 | Ip_u2s3u1(_ld); |
| 81 | Ip_u2s3u1(_ll); |
| 82 | Ip_u2s3u1(_lld); |
| 83 | Ip_u1s2(_lui); |
| 84 | Ip_u2s3u1(_lw); |
| 85 | Ip_u1u2u3(_mfc0); |
| 86 | Ip_u1u2u3(_mtc0); |
| 87 | Ip_u2u1u3(_ori); |
Ralf Baechle | 5808184 | 2010-03-23 15:54:50 +0100 | [diff] [blame] | 88 | Ip_u3u1u2(_or); |
Thiemo Seufer | fb2a27e7 | 2008-02-18 19:32:49 +0000 | [diff] [blame] | 89 | Ip_u2s3u1(_pref); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 90 | Ip_0(_rfe); |
| 91 | Ip_u2s3u1(_sc); |
| 92 | Ip_u2s3u1(_scd); |
| 93 | Ip_u2s3u1(_sd); |
| 94 | Ip_u2u1u3(_sll); |
| 95 | Ip_u2u1u3(_sra); |
| 96 | Ip_u2u1u3(_srl); |
David Daney | 32546f3 | 2010-02-10 15:12:46 -0800 | [diff] [blame] | 97 | Ip_u2u1u3(_rotr); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 98 | Ip_u3u1u2(_subu); |
| 99 | Ip_u2s3u1(_sw); |
| 100 | Ip_0(_tlbp); |
David Daney | 32546f3 | 2010-02-10 15:12:46 -0800 | [diff] [blame] | 101 | Ip_0(_tlbr); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 102 | Ip_0(_tlbwi); |
| 103 | Ip_0(_tlbwr); |
| 104 | Ip_u3u1u2(_xor); |
| 105 | Ip_u2u1u3(_xori); |
David Daney | 92078e0 | 2009-10-14 12:16:55 -0700 | [diff] [blame] | 106 | Ip_u2u1msbu3(_dins); |
David Daney | 58b9e22 | 2010-02-18 16:13:03 -0800 | [diff] [blame] | 107 | Ip_u1(_syscall); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 108 | |
| 109 | /* Handle labels. */ |
| 110 | struct uasm_label { |
| 111 | u32 *addr; |
| 112 | int lab; |
| 113 | }; |
| 114 | |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 115 | void __cpuinit uasm_build_label(struct uasm_label **lab, u32 *addr, int lid); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 116 | #ifdef CONFIG_64BIT |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 117 | int uasm_in_compat_space_p(long addr); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 118 | #endif |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 119 | int uasm_rel_hi(long val); |
| 120 | int uasm_rel_lo(long val); |
| 121 | void UASM_i_LA_mostly(u32 **buf, unsigned int rs, long addr); |
| 122 | void UASM_i_LA(u32 **buf, unsigned int rs, long addr); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 123 | |
| 124 | #define UASM_L_LA(lb) \ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 125 | static inline void __cpuinit uasm_l##lb(struct uasm_label **lab, u32 *addr) \ |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 126 | { \ |
| 127 | uasm_build_label(lab, addr, label##lb); \ |
| 128 | } |
| 129 | |
| 130 | /* convenience macros for instructions */ |
| 131 | #ifdef CONFIG_64BIT |
| 132 | # define UASM_i_LW(buf, rs, rt, off) uasm_i_ld(buf, rs, rt, off) |
| 133 | # define UASM_i_SW(buf, rs, rt, off) uasm_i_sd(buf, rs, rt, off) |
| 134 | # define UASM_i_SLL(buf, rs, rt, sh) uasm_i_dsll(buf, rs, rt, sh) |
| 135 | # define UASM_i_SRA(buf, rs, rt, sh) uasm_i_dsra(buf, rs, rt, sh) |
| 136 | # define UASM_i_SRL(buf, rs, rt, sh) uasm_i_dsrl(buf, rs, rt, sh) |
David Daney | 32546f3 | 2010-02-10 15:12:46 -0800 | [diff] [blame] | 137 | # define UASM_i_ROTR(buf, rs, rt, sh) uasm_i_drotr(buf, rs, rt, sh) |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 138 | # define UASM_i_MFC0(buf, rt, rd...) uasm_i_dmfc0(buf, rt, rd) |
| 139 | # define UASM_i_MTC0(buf, rt, rd...) uasm_i_dmtc0(buf, rt, rd) |
| 140 | # define UASM_i_ADDIU(buf, rs, rt, val) uasm_i_daddiu(buf, rs, rt, val) |
| 141 | # define UASM_i_ADDU(buf, rs, rt, rd) uasm_i_daddu(buf, rs, rt, rd) |
| 142 | # define UASM_i_SUBU(buf, rs, rt, rd) uasm_i_dsubu(buf, rs, rt, rd) |
| 143 | # define UASM_i_LL(buf, rs, rt, off) uasm_i_lld(buf, rs, rt, off) |
| 144 | # define UASM_i_SC(buf, rs, rt, off) uasm_i_scd(buf, rs, rt, off) |
| 145 | #else |
| 146 | # define UASM_i_LW(buf, rs, rt, off) uasm_i_lw(buf, rs, rt, off) |
| 147 | # define UASM_i_SW(buf, rs, rt, off) uasm_i_sw(buf, rs, rt, off) |
| 148 | # define UASM_i_SLL(buf, rs, rt, sh) uasm_i_sll(buf, rs, rt, sh) |
| 149 | # define UASM_i_SRA(buf, rs, rt, sh) uasm_i_sra(buf, rs, rt, sh) |
| 150 | # define UASM_i_SRL(buf, rs, rt, sh) uasm_i_srl(buf, rs, rt, sh) |
David Daney | 32546f3 | 2010-02-10 15:12:46 -0800 | [diff] [blame] | 151 | # define UASM_i_ROTR(buf, rs, rt, sh) uasm_i_rotr(buf, rs, rt, sh) |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 152 | # define UASM_i_MFC0(buf, rt, rd...) uasm_i_mfc0(buf, rt, rd) |
| 153 | # define UASM_i_MTC0(buf, rt, rd...) uasm_i_mtc0(buf, rt, rd) |
| 154 | # define UASM_i_ADDIU(buf, rs, rt, val) uasm_i_addiu(buf, rs, rt, val) |
| 155 | # define UASM_i_ADDU(buf, rs, rt, rd) uasm_i_addu(buf, rs, rt, rd) |
| 156 | # define UASM_i_SUBU(buf, rs, rt, rd) uasm_i_subu(buf, rs, rt, rd) |
| 157 | # define UASM_i_LL(buf, rs, rt, off) uasm_i_ll(buf, rs, rt, off) |
| 158 | # define UASM_i_SC(buf, rs, rt, off) uasm_i_sc(buf, rs, rt, off) |
| 159 | #endif |
| 160 | |
| 161 | #define uasm_i_b(buf, off) uasm_i_beq(buf, 0, 0, off) |
| 162 | #define uasm_i_beqz(buf, rs, off) uasm_i_beq(buf, rs, 0, off) |
| 163 | #define uasm_i_beqzl(buf, rs, off) uasm_i_beql(buf, rs, 0, off) |
| 164 | #define uasm_i_bnez(buf, rs, off) uasm_i_bne(buf, rs, 0, off) |
| 165 | #define uasm_i_bnezl(buf, rs, off) uasm_i_bnel(buf, rs, 0, off) |
| 166 | #define uasm_i_move(buf, a, b) UASM_i_ADDU(buf, a, 0, b) |
| 167 | #define uasm_i_nop(buf) uasm_i_sll(buf, 0, 0, 0) |
| 168 | #define uasm_i_ssnop(buf) uasm_i_sll(buf, 0, 0, 1) |
| 169 | #define uasm_i_ehb(buf) uasm_i_sll(buf, 0, 0, 3) |
| 170 | |
David Daney | 26b9e54 | 2010-04-28 12:16:16 -0700 | [diff] [blame] | 171 | static inline void uasm_i_dsrl_safe(u32 **p, unsigned int a1, |
| 172 | unsigned int a2, unsigned int a3) |
| 173 | { |
| 174 | if (a3 < 32) |
| 175 | uasm_i_dsrl(p, a1, a2, a3); |
| 176 | else |
| 177 | uasm_i_dsrl32(p, a1, a2, a3 - 32); |
| 178 | } |
| 179 | |
David Daney | de6d5b55 | 2010-07-23 18:41:41 -0700 | [diff] [blame] | 180 | static inline void uasm_i_drotr_safe(u32 **p, unsigned int a1, |
| 181 | unsigned int a2, unsigned int a3) |
| 182 | { |
| 183 | if (a3 < 32) |
| 184 | uasm_i_drotr(p, a1, a2, a3); |
| 185 | else |
| 186 | uasm_i_drotr32(p, a1, a2, a3 - 32); |
| 187 | } |
| 188 | |
David Daney | 26b9e54 | 2010-04-28 12:16:16 -0700 | [diff] [blame] | 189 | static inline void uasm_i_dsll_safe(u32 **p, unsigned int a1, |
| 190 | unsigned int a2, unsigned int a3) |
| 191 | { |
| 192 | if (a3 < 32) |
| 193 | uasm_i_dsll(p, a1, a2, a3); |
| 194 | else |
| 195 | uasm_i_dsll32(p, a1, a2, a3 - 32); |
| 196 | } |
| 197 | |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 198 | /* Handle relocations. */ |
| 199 | struct uasm_reloc { |
| 200 | u32 *addr; |
| 201 | unsigned int type; |
| 202 | int lab; |
| 203 | }; |
| 204 | |
| 205 | /* This is zero so we can use zeroed label arrays. */ |
| 206 | #define UASM_LABEL_INVALID 0 |
| 207 | |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 208 | void uasm_r_mips_pc16(struct uasm_reloc **rel, u32 *addr, int lid); |
| 209 | void uasm_resolve_relocs(struct uasm_reloc *rel, struct uasm_label *lab); |
| 210 | void uasm_move_relocs(struct uasm_reloc *rel, u32 *first, u32 *end, long off); |
| 211 | void uasm_move_labels(struct uasm_label *lab, u32 *first, u32 *end, long off); |
| 212 | void uasm_copy_handler(struct uasm_reloc *rel, struct uasm_label *lab, |
| 213 | u32 *first, u32 *end, u32 *target); |
| 214 | int uasm_insn_has_bdelay(struct uasm_reloc *rel, u32 *addr); |
Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 215 | |
| 216 | /* Convenience functions for labeled branches. */ |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 217 | void uasm_il_bltz(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); |
| 218 | void uasm_il_b(u32 **p, struct uasm_reloc **r, int lid); |
| 219 | void uasm_il_beqz(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); |
| 220 | void uasm_il_beqzl(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); |
Thiemo Seufer | fb2a27e7 | 2008-02-18 19:32:49 +0000 | [diff] [blame] | 221 | void uasm_il_bne(u32 **p, struct uasm_reloc **r, unsigned int reg1, |
| 222 | unsigned int reg2, int lid); |
Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 223 | void uasm_il_bnez(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); |
| 224 | void uasm_il_bgezl(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); |
| 225 | void uasm_il_bgez(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); |
David Daney | 5b97c3f | 2010-07-23 18:41:42 -0700 | [diff] [blame^] | 226 | void uasm_il_bbit0(u32 **p, struct uasm_reloc **r, unsigned int reg, |
| 227 | unsigned int bit, int lid); |
| 228 | void uasm_il_bbit1(u32 **p, struct uasm_reloc **r, unsigned int reg, |
| 229 | unsigned int bit, int lid); |