| 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 | fb2a27e | 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); | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 74 | Ip_u3u1u2(_dsubu); | 
 | 75 | Ip_0(_eret); | 
 | 76 | Ip_u1(_j); | 
 | 77 | Ip_u1(_jal); | 
 | 78 | Ip_u1(_jr); | 
 | 79 | Ip_u2s3u1(_ld); | 
 | 80 | Ip_u2s3u1(_ll); | 
 | 81 | Ip_u2s3u1(_lld); | 
 | 82 | Ip_u1s2(_lui); | 
 | 83 | Ip_u2s3u1(_lw); | 
 | 84 | Ip_u1u2u3(_mfc0); | 
 | 85 | Ip_u1u2u3(_mtc0); | 
 | 86 | Ip_u2u1u3(_ori); | 
| Ralf Baechle | 5808184 | 2010-03-23 15:54:50 +0100 | [diff] [blame] | 87 | Ip_u3u1u2(_or); | 
| Thiemo Seufer | fb2a27e | 2008-02-18 19:32:49 +0000 | [diff] [blame] | 88 | Ip_u2s3u1(_pref); | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 89 | Ip_0(_rfe); | 
 | 90 | Ip_u2s3u1(_sc); | 
 | 91 | Ip_u2s3u1(_scd); | 
 | 92 | Ip_u2s3u1(_sd); | 
 | 93 | Ip_u2u1u3(_sll); | 
 | 94 | Ip_u2u1u3(_sra); | 
 | 95 | Ip_u2u1u3(_srl); | 
| David Daney | 32546f3 | 2010-02-10 15:12:46 -0800 | [diff] [blame] | 96 | Ip_u2u1u3(_rotr); | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 97 | Ip_u3u1u2(_subu); | 
 | 98 | Ip_u2s3u1(_sw); | 
 | 99 | Ip_0(_tlbp); | 
| David Daney | 32546f3 | 2010-02-10 15:12:46 -0800 | [diff] [blame] | 100 | Ip_0(_tlbr); | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 101 | Ip_0(_tlbwi); | 
 | 102 | Ip_0(_tlbwr); | 
 | 103 | Ip_u3u1u2(_xor); | 
 | 104 | Ip_u2u1u3(_xori); | 
| David Daney | 92078e0 | 2009-10-14 12:16:55 -0700 | [diff] [blame] | 105 | Ip_u2u1msbu3(_dins); | 
| David Daney | 58b9e22 | 2010-02-18 16:13:03 -0800 | [diff] [blame] | 106 | Ip_u1(_syscall); | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 107 |  | 
 | 108 | /* Handle labels. */ | 
 | 109 | struct uasm_label { | 
 | 110 | 	u32 *addr; | 
 | 111 | 	int lab; | 
 | 112 | }; | 
 | 113 |  | 
| Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 114 | 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] | 115 | #ifdef CONFIG_64BIT | 
| Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 116 | int uasm_in_compat_space_p(long addr); | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 117 | #endif | 
| Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 118 | int uasm_rel_hi(long val); | 
 | 119 | int uasm_rel_lo(long val); | 
 | 120 | void UASM_i_LA_mostly(u32 **buf, unsigned int rs, long addr); | 
 | 121 | void UASM_i_LA(u32 **buf, unsigned int rs, long addr); | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 122 |  | 
 | 123 | #define UASM_L_LA(lb)							\ | 
| Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 124 | 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] | 125 | {									\ | 
 | 126 | 	uasm_build_label(lab, addr, label##lb);				\ | 
 | 127 | } | 
 | 128 |  | 
 | 129 | /* convenience macros for instructions */ | 
 | 130 | #ifdef CONFIG_64BIT | 
 | 131 | # define UASM_i_LW(buf, rs, rt, off) uasm_i_ld(buf, rs, rt, off) | 
 | 132 | # define UASM_i_SW(buf, rs, rt, off) uasm_i_sd(buf, rs, rt, off) | 
 | 133 | # define UASM_i_SLL(buf, rs, rt, sh) uasm_i_dsll(buf, rs, rt, sh) | 
 | 134 | # define UASM_i_SRA(buf, rs, rt, sh) uasm_i_dsra(buf, rs, rt, sh) | 
 | 135 | # 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] | 136 | # 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] | 137 | # define UASM_i_MFC0(buf, rt, rd...) uasm_i_dmfc0(buf, rt, rd) | 
 | 138 | # define UASM_i_MTC0(buf, rt, rd...) uasm_i_dmtc0(buf, rt, rd) | 
 | 139 | # define UASM_i_ADDIU(buf, rs, rt, val) uasm_i_daddiu(buf, rs, rt, val) | 
 | 140 | # define UASM_i_ADDU(buf, rs, rt, rd) uasm_i_daddu(buf, rs, rt, rd) | 
 | 141 | # define UASM_i_SUBU(buf, rs, rt, rd) uasm_i_dsubu(buf, rs, rt, rd) | 
 | 142 | # define UASM_i_LL(buf, rs, rt, off) uasm_i_lld(buf, rs, rt, off) | 
 | 143 | # define UASM_i_SC(buf, rs, rt, off) uasm_i_scd(buf, rs, rt, off) | 
 | 144 | #else | 
 | 145 | # define UASM_i_LW(buf, rs, rt, off) uasm_i_lw(buf, rs, rt, off) | 
 | 146 | # define UASM_i_SW(buf, rs, rt, off) uasm_i_sw(buf, rs, rt, off) | 
 | 147 | # define UASM_i_SLL(buf, rs, rt, sh) uasm_i_sll(buf, rs, rt, sh) | 
 | 148 | # define UASM_i_SRA(buf, rs, rt, sh) uasm_i_sra(buf, rs, rt, sh) | 
 | 149 | # 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] | 150 | # 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] | 151 | # define UASM_i_MFC0(buf, rt, rd...) uasm_i_mfc0(buf, rt, rd) | 
 | 152 | # define UASM_i_MTC0(buf, rt, rd...) uasm_i_mtc0(buf, rt, rd) | 
 | 153 | # define UASM_i_ADDIU(buf, rs, rt, val) uasm_i_addiu(buf, rs, rt, val) | 
 | 154 | # define UASM_i_ADDU(buf, rs, rt, rd) uasm_i_addu(buf, rs, rt, rd) | 
 | 155 | # define UASM_i_SUBU(buf, rs, rt, rd) uasm_i_subu(buf, rs, rt, rd) | 
 | 156 | # define UASM_i_LL(buf, rs, rt, off) uasm_i_ll(buf, rs, rt, off) | 
 | 157 | # define UASM_i_SC(buf, rs, rt, off) uasm_i_sc(buf, rs, rt, off) | 
 | 158 | #endif | 
 | 159 |  | 
 | 160 | #define uasm_i_b(buf, off) uasm_i_beq(buf, 0, 0, off) | 
 | 161 | #define uasm_i_beqz(buf, rs, off) uasm_i_beq(buf, rs, 0, off) | 
 | 162 | #define uasm_i_beqzl(buf, rs, off) uasm_i_beql(buf, rs, 0, off) | 
 | 163 | #define uasm_i_bnez(buf, rs, off) uasm_i_bne(buf, rs, 0, off) | 
 | 164 | #define uasm_i_bnezl(buf, rs, off) uasm_i_bnel(buf, rs, 0, off) | 
 | 165 | #define uasm_i_move(buf, a, b) UASM_i_ADDU(buf, a, 0, b) | 
 | 166 | #define uasm_i_nop(buf) uasm_i_sll(buf, 0, 0, 0) | 
 | 167 | #define uasm_i_ssnop(buf) uasm_i_sll(buf, 0, 0, 1) | 
 | 168 | #define uasm_i_ehb(buf) uasm_i_sll(buf, 0, 0, 3) | 
 | 169 |  | 
| David Daney | 26b9e54 | 2010-04-28 12:16:16 -0700 | [diff] [blame] | 170 | static inline void uasm_i_dsrl_safe(u32 **p, unsigned int a1, | 
 | 171 | 				    unsigned int a2, unsigned int a3) | 
 | 172 | { | 
 | 173 | 	if (a3 < 32) | 
 | 174 | 		uasm_i_dsrl(p, a1, a2, a3); | 
 | 175 | 	else | 
 | 176 | 		uasm_i_dsrl32(p, a1, a2, a3 - 32); | 
 | 177 | } | 
 | 178 |  | 
 | 179 | static inline void uasm_i_dsll_safe(u32 **p, unsigned int a1, | 
 | 180 | 				    unsigned int a2, unsigned int a3) | 
 | 181 | { | 
 | 182 | 	if (a3 < 32) | 
 | 183 | 		uasm_i_dsll(p, a1, a2, a3); | 
 | 184 | 	else | 
 | 185 | 		uasm_i_dsll32(p, a1, a2, a3 - 32); | 
 | 186 | } | 
 | 187 |  | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 188 | /* Handle relocations. */ | 
 | 189 | struct uasm_reloc { | 
 | 190 | 	u32 *addr; | 
 | 191 | 	unsigned int type; | 
 | 192 | 	int lab; | 
 | 193 | }; | 
 | 194 |  | 
 | 195 | /* This is zero so we can use zeroed label arrays. */ | 
 | 196 | #define UASM_LABEL_INVALID 0 | 
 | 197 |  | 
| Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 198 | void uasm_r_mips_pc16(struct uasm_reloc **rel, u32 *addr, int lid); | 
 | 199 | void uasm_resolve_relocs(struct uasm_reloc *rel, struct uasm_label *lab); | 
 | 200 | void uasm_move_relocs(struct uasm_reloc *rel, u32 *first, u32 *end, long off); | 
 | 201 | void uasm_move_labels(struct uasm_label *lab, u32 *first, u32 *end, long off); | 
 | 202 | void uasm_copy_handler(struct uasm_reloc *rel, struct uasm_label *lab, | 
 | 203 | 	u32 *first, u32 *end, u32 *target); | 
 | 204 | int uasm_insn_has_bdelay(struct uasm_reloc *rel, u32 *addr); | 
| Thiemo Seufer | e30ec45 | 2008-01-28 20:05:38 +0000 | [diff] [blame] | 205 |  | 
 | 206 | /* Convenience functions for labeled branches. */ | 
| Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 207 | void uasm_il_bltz(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); | 
 | 208 | void uasm_il_b(u32 **p, struct uasm_reloc **r, int lid); | 
 | 209 | void uasm_il_beqz(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); | 
 | 210 | void uasm_il_beqzl(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); | 
| Thiemo Seufer | fb2a27e | 2008-02-18 19:32:49 +0000 | [diff] [blame] | 211 | void uasm_il_bne(u32 **p, struct uasm_reloc **r, unsigned int reg1, | 
 | 212 | 		 unsigned int reg2, int lid); | 
| Ralf Baechle | 234fcd1 | 2008-03-08 09:56:28 +0000 | [diff] [blame] | 213 | void uasm_il_bnez(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); | 
 | 214 | void uasm_il_bgezl(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); | 
 | 215 | void uasm_il_bgez(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid); |