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 #ifdef CONFIG_EXPORT_UASM
14 #include <linux/module.h>
15 #define __uasminit
16 #define __uasminitdata
17 #define UASM_EXPORT_SYMBOL(sym) EXPORT_SYMBOL(sym)
18 #else
19 #define __uasminit __cpuinit
20 #define __uasminitdata __cpuinitdata
21 #define UASM_EXPORT_SYMBOL(sym)
22 #endif
23 
24 #define Ip_u1u2u3(op)							\
25 void __uasminit								\
26 uasm_i##op(u32 **buf, unsigned int a, unsigned int b, unsigned int c)
27 
28 #define Ip_u2u1u3(op)							\
29 void __uasminit								\
30 uasm_i##op(u32 **buf, unsigned int a, unsigned int b, unsigned int c)
31 
32 #define Ip_u3u1u2(op)							\
33 void __uasminit								\
34 uasm_i##op(u32 **buf, unsigned int a, unsigned int b, unsigned int c)
35 
36 #define Ip_u1u2s3(op)							\
37 void __uasminit								\
38 uasm_i##op(u32 **buf, unsigned int a, unsigned int b, signed int c)
39 
40 #define Ip_u2s3u1(op)							\
41 void __uasminit								\
42 uasm_i##op(u32 **buf, unsigned int a, signed int b, unsigned int c)
43 
44 #define Ip_u2u1s3(op)							\
45 void __uasminit								\
46 uasm_i##op(u32 **buf, unsigned int a, unsigned int b, signed int c)
47 
48 #define Ip_u2u1msbu3(op)						\
49 void __uasminit								\
50 uasm_i##op(u32 **buf, unsigned int a, unsigned int b, unsigned int c,	\
51 	   unsigned int d)
52 
53 #define Ip_u1u2(op)							\
54 void __uasminit uasm_i##op(u32 **buf, unsigned int a, unsigned int b)
55 
56 #define Ip_u1s2(op)							\
57 void __uasminit uasm_i##op(u32 **buf, unsigned int a, signed int b)
58 
59 #define Ip_u1(op) void __uasminit uasm_i##op(u32 **buf, unsigned int a)
60 
61 #define Ip_0(op) void __uasminit uasm_i##op(u32 **buf)
62 
63 Ip_u2u1s3(_addiu);
64 Ip_u3u1u2(_addu);
65 Ip_u2u1u3(_andi);
66 Ip_u3u1u2(_and);
67 Ip_u1u2s3(_beq);
68 Ip_u1u2s3(_beql);
69 Ip_u1s2(_bgez);
70 Ip_u1s2(_bgezl);
71 Ip_u1s2(_bltz);
72 Ip_u1s2(_bltzl);
73 Ip_u1u2s3(_bne);
74 Ip_u2s3u1(_cache);
75 Ip_u1u2u3(_dmfc0);
76 Ip_u1u2u3(_dmtc0);
77 Ip_u2u1s3(_daddiu);
78 Ip_u3u1u2(_daddu);
79 Ip_u2u1u3(_dsll);
80 Ip_u2u1u3(_dsll32);
81 Ip_u2u1u3(_dsra);
82 Ip_u2u1u3(_dsrl);
83 Ip_u2u1u3(_dsrl32);
84 Ip_u2u1u3(_drotr);
85 Ip_u2u1u3(_drotr32);
86 Ip_u3u1u2(_dsubu);
87 Ip_0(_eret);
88 Ip_u1(_j);
89 Ip_u1(_jal);
90 Ip_u1(_jr);
91 Ip_u2s3u1(_ld);
92 Ip_u2s3u1(_ll);
93 Ip_u2s3u1(_lld);
94 Ip_u1s2(_lui);
95 Ip_u2s3u1(_lw);
96 Ip_u1u2u3(_mfc0);
97 Ip_u1u2u3(_mtc0);
98 Ip_u2u1u3(_ori);
99 Ip_u3u1u2(_or);
100 Ip_u2s3u1(_pref);
101 Ip_0(_rfe);
102 Ip_u2s3u1(_sc);
103 Ip_u2s3u1(_scd);
104 Ip_u2s3u1(_sd);
105 Ip_u2u1u3(_sll);
106 Ip_u2u1u3(_sra);
107 Ip_u2u1u3(_srl);
108 Ip_u2u1u3(_rotr);
109 Ip_u3u1u2(_subu);
110 Ip_u2s3u1(_sw);
111 Ip_0(_tlbp);
112 Ip_0(_tlbr);
113 Ip_0(_tlbwi);
114 Ip_0(_tlbwr);
115 Ip_u3u1u2(_xor);
116 Ip_u2u1u3(_xori);
117 Ip_u2u1msbu3(_dins);
118 Ip_u2u1msbu3(_dinsm);
119 Ip_u1(_syscall);
120 Ip_u1u2s3(_bbit0);
121 Ip_u1u2s3(_bbit1);
122 Ip_u3u1u2(_lwx);
123 Ip_u3u1u2(_ldx);
124 
125 /* Handle labels. */
126 struct uasm_label {
127 	u32 *addr;
128 	int lab;
129 };
130 
131 void __uasminit uasm_build_label(struct uasm_label **lab, u32 *addr, int lid);
132 #ifdef CONFIG_64BIT
133 int uasm_in_compat_space_p(long addr);
134 #endif
135 int uasm_rel_hi(long val);
136 int uasm_rel_lo(long val);
137 void UASM_i_LA_mostly(u32 **buf, unsigned int rs, long addr);
138 void UASM_i_LA(u32 **buf, unsigned int rs, long addr);
139 
140 #define UASM_L_LA(lb)							\
141 static inline void __uasminit uasm_l##lb(struct uasm_label **lab, u32 *addr) \
142 {									\
143 	uasm_build_label(lab, addr, label##lb);				\
144 }
145 
146 /* convenience macros for instructions */
147 #ifdef CONFIG_64BIT
148 # define UASM_i_LW(buf, rs, rt, off) uasm_i_ld(buf, rs, rt, off)
149 # define UASM_i_SW(buf, rs, rt, off) uasm_i_sd(buf, rs, rt, off)
150 # define UASM_i_SLL(buf, rs, rt, sh) uasm_i_dsll(buf, rs, rt, sh)
151 # define UASM_i_SRA(buf, rs, rt, sh) uasm_i_dsra(buf, rs, rt, sh)
152 # define UASM_i_SRL(buf, rs, rt, sh) uasm_i_dsrl(buf, rs, rt, sh)
153 # define UASM_i_ROTR(buf, rs, rt, sh) uasm_i_drotr(buf, rs, rt, sh)
154 # define UASM_i_MFC0(buf, rt, rd...) uasm_i_dmfc0(buf, rt, rd)
155 # define UASM_i_MTC0(buf, rt, rd...) uasm_i_dmtc0(buf, rt, rd)
156 # define UASM_i_ADDIU(buf, rs, rt, val) uasm_i_daddiu(buf, rs, rt, val)
157 # define UASM_i_ADDU(buf, rs, rt, rd) uasm_i_daddu(buf, rs, rt, rd)
158 # define UASM_i_SUBU(buf, rs, rt, rd) uasm_i_dsubu(buf, rs, rt, rd)
159 # define UASM_i_LL(buf, rs, rt, off) uasm_i_lld(buf, rs, rt, off)
160 # define UASM_i_SC(buf, rs, rt, off) uasm_i_scd(buf, rs, rt, off)
161 # define UASM_i_LWX(buf, rs, rt, rd) uasm_i_ldx(buf, rs, rt, rd)
162 #else
163 # define UASM_i_LW(buf, rs, rt, off) uasm_i_lw(buf, rs, rt, off)
164 # define UASM_i_SW(buf, rs, rt, off) uasm_i_sw(buf, rs, rt, off)
165 # define UASM_i_SLL(buf, rs, rt, sh) uasm_i_sll(buf, rs, rt, sh)
166 # define UASM_i_SRA(buf, rs, rt, sh) uasm_i_sra(buf, rs, rt, sh)
167 # define UASM_i_SRL(buf, rs, rt, sh) uasm_i_srl(buf, rs, rt, sh)
168 # define UASM_i_ROTR(buf, rs, rt, sh) uasm_i_rotr(buf, rs, rt, sh)
169 # define UASM_i_MFC0(buf, rt, rd...) uasm_i_mfc0(buf, rt, rd)
170 # define UASM_i_MTC0(buf, rt, rd...) uasm_i_mtc0(buf, rt, rd)
171 # define UASM_i_ADDIU(buf, rs, rt, val) uasm_i_addiu(buf, rs, rt, val)
172 # define UASM_i_ADDU(buf, rs, rt, rd) uasm_i_addu(buf, rs, rt, rd)
173 # define UASM_i_SUBU(buf, rs, rt, rd) uasm_i_subu(buf, rs, rt, rd)
174 # define UASM_i_LL(buf, rs, rt, off) uasm_i_ll(buf, rs, rt, off)
175 # define UASM_i_SC(buf, rs, rt, off) uasm_i_sc(buf, rs, rt, off)
176 # define UASM_i_LWX(buf, rs, rt, rd) uasm_i_lwx(buf, rs, rt, rd)
177 #endif
178 
179 #define uasm_i_b(buf, off) uasm_i_beq(buf, 0, 0, off)
180 #define uasm_i_beqz(buf, rs, off) uasm_i_beq(buf, rs, 0, off)
181 #define uasm_i_beqzl(buf, rs, off) uasm_i_beql(buf, rs, 0, off)
182 #define uasm_i_bnez(buf, rs, off) uasm_i_bne(buf, rs, 0, off)
183 #define uasm_i_bnezl(buf, rs, off) uasm_i_bnel(buf, rs, 0, off)
184 #define uasm_i_move(buf, a, b) UASM_i_ADDU(buf, a, 0, b)
185 #define uasm_i_nop(buf) uasm_i_sll(buf, 0, 0, 0)
186 #define uasm_i_ssnop(buf) uasm_i_sll(buf, 0, 0, 1)
187 #define uasm_i_ehb(buf) uasm_i_sll(buf, 0, 0, 3)
188 
uasm_i_dsrl_safe(u32 ** p,unsigned int a1,unsigned int a2,unsigned int a3)189 static inline void uasm_i_dsrl_safe(u32 **p, unsigned int a1,
190 				    unsigned int a2, unsigned int a3)
191 {
192 	if (a3 < 32)
193 		uasm_i_dsrl(p, a1, a2, a3);
194 	else
195 		uasm_i_dsrl32(p, a1, a2, a3 - 32);
196 }
197 
uasm_i_drotr_safe(u32 ** p,unsigned int a1,unsigned int a2,unsigned int a3)198 static inline void uasm_i_drotr_safe(u32 **p, unsigned int a1,
199 				     unsigned int a2, unsigned int a3)
200 {
201 	if (a3 < 32)
202 		uasm_i_drotr(p, a1, a2, a3);
203 	else
204 		uasm_i_drotr32(p, a1, a2, a3 - 32);
205 }
206 
uasm_i_dsll_safe(u32 ** p,unsigned int a1,unsigned int a2,unsigned int a3)207 static inline void uasm_i_dsll_safe(u32 **p, unsigned int a1,
208 				    unsigned int a2, unsigned int a3)
209 {
210 	if (a3 < 32)
211 		uasm_i_dsll(p, a1, a2, a3);
212 	else
213 		uasm_i_dsll32(p, a1, a2, a3 - 32);
214 }
215 
216 /* Handle relocations. */
217 struct uasm_reloc {
218 	u32 *addr;
219 	unsigned int type;
220 	int lab;
221 };
222 
223 /* This is zero so we can use zeroed label arrays. */
224 #define UASM_LABEL_INVALID 0
225 
226 void uasm_r_mips_pc16(struct uasm_reloc **rel, u32 *addr, int lid);
227 void uasm_resolve_relocs(struct uasm_reloc *rel, struct uasm_label *lab);
228 void uasm_move_relocs(struct uasm_reloc *rel, u32 *first, u32 *end, long off);
229 void uasm_move_labels(struct uasm_label *lab, u32 *first, u32 *end, long off);
230 void uasm_copy_handler(struct uasm_reloc *rel, struct uasm_label *lab,
231 	u32 *first, u32 *end, u32 *target);
232 int uasm_insn_has_bdelay(struct uasm_reloc *rel, u32 *addr);
233 
234 /* Convenience functions for labeled branches. */
235 void uasm_il_bltz(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid);
236 void uasm_il_b(u32 **p, struct uasm_reloc **r, int lid);
237 void uasm_il_beqz(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid);
238 void uasm_il_beqzl(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid);
239 void uasm_il_bne(u32 **p, struct uasm_reloc **r, unsigned int reg1,
240 		 unsigned int reg2, int lid);
241 void uasm_il_bnez(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid);
242 void uasm_il_bgezl(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid);
243 void uasm_il_bgez(u32 **p, struct uasm_reloc **r, unsigned int reg, int lid);
244 void uasm_il_bbit0(u32 **p, struct uasm_reloc **r, unsigned int reg,
245 		   unsigned int bit, int lid);
246 void uasm_il_bbit1(u32 **p, struct uasm_reloc **r, unsigned int reg,
247 		   unsigned int bit, int lid);
248