开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > Windows CE > 查看源码
dyncode_mips.c
资源名称：tcpmp.rar　[点击查看]
上传用户：wstnjxml
上传日期：2014-04-03
资源大小：7248k
文件大小：11k
源码类别：

Windows CE

开发平台：

C/C++

dyncode_mips.c：源码内容
  1. /*****************************************************************************
  2.  *
  3.  * This program is free software ; you can redistribute it and/or modify
  4.  * it under the terms of the GNU General Public License as published by
  5.  * the Free Software Foundation; either version 2 of the License, or
  6.  * (at your option) any later version.
  7.  *
  8.  * This program is distributed in the hope that it will be useful,
  9.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11.  * GNU General Public License for more details.
  12.  *
  13.  * You should have received a copy of the GNU General Public License
  14.  * along with this program; if not, write to the Free Software
  15.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  16.  *
  17.  * $Id: dyncode_mips.c 585 2006-01-16 09:48:55Z picard $
  18.  *
  19.  * The Core Pocket Media Player
  20.  * Copyright (c) 2004-2005 Gabor Kovacs
  21.  *
  22.  ****************************************************************************/
  24. #include "../common.h"
  25. #include "dyncode.h"
  27. #if defined(MIPS) && defined(CONFIG_DYNCODE)
  29. //format coded in 'code' at 8bit position
  30. //00: rs,rt,offset(s16<<2) (branch)
  31. //01: rs,rt,rd
  32. //02: rs,rt,immd(s16) write rt
  33. //03: rs,offset(s16<<2)
  34. //04: rs,rt ->lo,hi
  35. //05: rt,rd,sa
  36. //06: rt,rs,rd
  37. //07: addr(s26<<2)
  38. //08: rs,rt (branch)
  39. //09: rs (branch)
  40. //0A: rs,immd(s16)
  41. //0B: rd <-> lo,hi
  42. //0C: rs,rt,immd(s16) read rt
  44. #define LO 1
  45. #define HI 2
  47. static const reg SaveRegs[11] =
  48. {
  49. R16,R17,R18,R19,R20,R21,R22,R23,
  50. R30,R28,R31
  51. };
  53. void InstInit()
  54. {
  55. }
  57. static INLINE int Format(int i) { return (i >> 8) & 15; }
  58. static INLINE int C(int i) { return i & ~0xFF00; }
  60. void I3(int Code, reg Dest, reg Op1, reg Op2)
  61. {
  62. dyninst* p = NULL;
  63. if (Format(Code)==1)
  64. p = InstCreate32(C(Code) | (Dest << 11) | (Op1 << 21) | (Op2 << 16),Dest,Op1,Op2,0,0);
  65. if (Format(Code)==6)
  66. p = InstCreate32(C(Code) | (Dest << 11) | (Op2 << 21) | (Op1 << 16),Dest,Op1,Op2,0,0);
  67. InstPost(p);
  68. }
  70. void I2C(int Code, reg Dest, reg Op1, int Const)
  71. {
  72. dyninst* p = NULL;
  74. if (Code == DSLL && Const < 0)
  75. {
  76. Code = DSRL;
  77. Const = -Const;
  78. }
  79. if (Code == DSRL && Const < 0)
  80. {
  81. Code = DSLL;
  82. Const = -Const;
  83. }
  84. if (Code == SLL && Const < 0)
  85. {
  86. Code = SRL;
  87. Const = -Const;
  88. }
  89. if (Code == SRL && Const < 0)
  90. {
  91. Code = SLL;
  92. Const = -Const;
  93. }
  94. if (Code == SRA && Const < 0)
  95. {
  96. Code = SLL;
  97. Const = -Const;
  98. }
  99. if (Code == DSLL && Const >= 32)
  100. {
  101. Code = DSLL32;
  102. Const -= 32;
  103. }
  104. if (Code == DSRA && Const >= 32)
  105. {
  106. Code = DSRA32;
  107. Const -= 32;
  108. }
  109. if (Code == DSRL && Const >= 32)
  110. {
  111. Code = DSRL32;
  112. Const -= 32;
  113. }
  115. assert(Format(Code)!=4 || Const==0);
  116. if (Format(Code)==4 && Const == 0)
  117. {
  118. p = InstCreate32(C(Code) | (Dest << 21) | (Op1 << 16),NONE,Dest,Op1,0,LO|HI);
  119. }
  120. assert(Format(Code)!=8 || Const==0);
  121. if (Format(Code)==8 && Const == 0)
  122. {
  123. p = InstCreate32(C(Code) | (Dest << 11) | (Op1 << 21),Dest,Op1,NONE,0,0);
  124. if (p)
  125. p->Branch = 1;
  126. }
  127. assert(Format(Code)!=5 || (Const >= 0 && Const < 32));
  128. if (Format(Code)==5 && Const >= 0 && Const < 32)
  129. {
  130. p = InstCreate32(C(Code) | (Dest << 11) | (Op1 << 16) | (Const << 6),Dest,Op1,NONE,0,0);
  131. }
  132. if ((Code == ANDI || Code == ORI || Code == XORI) && Const >= 32768)
  133. Const -= 65536;
  134. assert(Format(Code)!=2 || (Const >= -32768 && Const < 32768));
  135. if (Format(Code)==2 && Const >= -32768 && Const < 32768)
  136. {
  137. p = InstCreate32(C(Code) | (Dest << 16) | (Op1 << 21) | (Const & 0xFFFF),Dest,Op1,NONE,0,0);
  138. }
  139. assert(Format(Code)!=12 || (Const >= -32768 && Const < 32768));
  140. if (Format(Code)==12 && Const >= -32768 && Const < 32768)
  141. {
  142. p = InstCreate32(C(Code) | (Dest << 16) | (Op1 << 21) | (Const & 0xFFFF),NONE,Op1,Dest,0,0);
  143. }
  144. InstPost(p);
  145. }
  147. void I2(int Code, reg Rm, reg Rn)
  148. {
  149. I2C(Code,Rm,Rn,0);
  150. }
  152. void I2P(int Code, reg Op1, reg Op2, dyninst* Block)
  153. {
  154. dyninst* p = NULL;
  155. if (Format(Code)==0)
  156. {
  157. p = InstCreate32(C(Code) | (Op2 << 16) | (Op1 << 21),NONE,Op1,Op2,0,0);
  158. if (p)
  159. {
  160. p->Tag = Format(Code);
  161. p->ReAlloc = Block;
  162. p->Branch = 1;
  163. }
  164. }
  165. InstPost(p);
  166. }
  168. void I1C(int Code, reg Reg, int Const)
  169. {
  170. dyninst* p = NULL;
  171. if (Format(Code)==10 && Const >= -32768 && Const < 32768)
  172. {
  173. p = InstCreate32(C(Code) | (Reg << 16) | (Const & 0xFFFF),Reg,NONE,NONE,0,0);
  174. }
  175. if (Format(Code)==11 && Const==0)
  176. {
  177. if (Code == MFHI) p = InstCreate32(C(Code) | (Reg << 11),Reg,NONE,NONE,HI,0);
  178. if (Code == MFLO) p = InstCreate32(C(Code) | (Reg << 11),Reg,NONE,NONE,LO,0);
  179. if (Code == MTHI) p = InstCreate32(C(Code) | (Reg << 21),NONE,Reg,NONE,0,HI);
  180. if (Code == MTLO) p = InstCreate32(C(Code) | (Reg << 21),NONE,Reg,NONE,0,LO);
  181. }
  182. if (Format(Code)==9 && Const==0)
  183. {
  184. p = InstCreate32(C(Code) | (Reg << 21),NONE,Reg,NONE,0,0);
  185. if (p)
  186. p->Branch = 1;
  187. }
  188. InstPost(p);
  189. }
  191. void I1(int Code, reg Rn)
  192. {
  193. I1C(Code,Rn,0);
  194. }
  196. void I1P(int Code, reg Reg, dyninst* Block, int Ofs)
  197. {
  198. dyninst* p = NULL;
  199. if (Format(Code)==3)
  200. {
  201. p = InstCreate32(C(Code) | (Reg << 21),NONE,Reg,NONE,0,0);
  202. if (p)
  203. {
  204. p->Tag = Format(Code);
  205. p->ReAlloc = Block;
  206. }
  207. }
  208. InstPost(p);
  209. }
  211. bool_t InstReAlloc(dyninst* p,dyninst* ReAlloc)
  212. {
  213. int Diff = ReAlloc->Address - (p->Address+4);
  214. int* Code = (int*) InstCode(p);
  216. if (p->CodeSize > 4)
  217. {
  218. // address table
  219. int i;
  220. for (i=0;i<p->CodeSize;i+=4,++Code)
  221. *Code += (int)ReAlloc->Address;
  222. return 1;
  223. }
  225. Diff >>= 2;
  226. assert(Diff <= 32767 && Diff >= -32768);
  227. if (Diff > 32767 || Diff < -32768)
  228. {
  229. DEBUG_MSG1(-1,T("Realloc failed %d"),Diff);
  230. return 0;
  231. }
  233. assert(p->Tag==0 || p->Tag==3);
  234. if (p->Tag == 0)
  235. {
  236. *Code &= ~0xFFFF;
  237. *Code |= (uint16_t)Diff;
  238. return 1;
  239. }
  240. else
  241. if (p->Tag == 3)
  242. {
  243. *Code &= ~0xFFFF;
  244. *Code |= (uint16_t)Diff;
  245. return 1;
  246. }
  248. DEBUG_MSG(-1,T("Realloc failed unknown tag"));
  249. return 0;
  250. }
  252. void CodeBegin(int Save,int Local,bool_t Align64)
  253. {
  254. int i;
  255. assert(Save <= 11);
  256. if (Align64)
  257. {
  258. I3(OR,R2,SP,SP);
  259. I2C(ADDIU,SP,SP,-8);
  260. I2C(ANDI,R8,SP,4);
  261. I3(ADDU,SP,SP,R8);
  262. I2C(SW,R8,SP,0);
  263. }
  264. if (Save || Local)
  265. {
  266. I2C(ADDIU,SP,SP,-Save*4-Local);
  267. for (i=0;i<Save;++i)
  268. I2C(SW,SaveRegs[i],SP,i*4+Local);
  269. }
  270. }
  272. void CodeEnd(int Save,int Local,bool_t Align64)
  273. {
  274. if (Save || Local)
  275. {
  276. int i;
  277. assert(Save <= 11);
  278. for (i=Save-1;i>=0;--i)
  279. I2C(LW,SaveRegs[i],SP,i*4+Local);
  280. I2C(ADDIU,SP,SP,Save*4+Local);
  281. }
  282. if (Align64)
  283. {
  284. I2C(LW,R8,SP,0);
  285. I3(SUBU,SP,SP,R8);
  286. I2C(ADDIU,SP,SP,8);
  287. }
  288. DS(); I1(JR,RA);
  289. }
  291. void NOP()
  292. {
  293. dyninst* p = InstCreate32(0,NONE,NONE,NONE,0,0);
  294. if (p)
  295. p->Branch = 1;
  296. InstPost(p);
  297. }
  299. void Break()
  300. {
  301. dyninst* p = InstCreate32(0x0000000D,NONE,NONE,NONE,0,0);
  302. if (p)
  303. p->Branch = 1;
  304. InstPost(p);
  305. }
  307. void InstPost(dyninst* p)
  308. {
  309. context* c = Context();
  310. InstAdd(p,c);
  311. }
  313. void IConst(reg Dst,int Const)
  314. {
  315. I1C(LUI,Dst,Const >> 16);
  316. I2C(ORI,Dst,Dst,(int16_t)Const);
  317. }
  319. reg IMul(reg Op1, int Mul, reg Tmp1, reg Tmp2, reg Tmp3, bool_t* Neg)
  320. {
  321. reg Result = Tmp3;
  323. if (Neg) 
  324. *Neg = 0;
  326. if (Mul>=0)
  327. switch (Mul)
  328. {
  329. case 0: Result=ZERO; break;
  330. case 1: Result=Op1; break;
  331. case 2: I3(ADDU,Result,Op1,Op1); break;
  332. case 3: I2C(SLL,Tmp1,Op1,1); I3(ADDU,Result,Tmp1,Op1); break;
  333. case 4: I2C(SLL,Result,Op1,2); break;
  334. case 5: I2C(SLL,Tmp1,Op1,2); I3(ADDU,Result,Tmp1,Op1); break;
  335. case 6: I2C(SLL,Tmp1,Op1,2); I2C(SLL,Tmp2,Op1,1); I3(ADDU,Result,Tmp1,Tmp2); break;
  336. case 7: I2C(SLL,Tmp1,Op1,3); I3(SUBU,Result,Tmp1,Op1); break;
  337. case 8: I2C(SLL,Result,Op1,3); break;
  338. case 9: I2C(SLL,Tmp1,Op1,3); I3(ADDU,Result,Tmp1,Op1); break;
  339. case 10: I2C(SLL,Tmp1,Op1,3); I2C(SLL,Tmp2,Op1,1); I3(ADDU,Result,Tmp1,Tmp2); break;
  340. case 11: I2C(SLL,Tmp1,Op1,3); I2C(SLL,Tmp2,Op1,1); I3(ADDU,Result,Tmp1,Tmp2); I3(ADDU,Result,Result,Op1); break;
  341. case 12: I2C(SLL,Tmp1,Op1,3); I2C(SLL,Tmp2,Op1,2); I3(ADDU,Result,Tmp1,Tmp2); break; 
  342. case 13: I2C(SLL,Tmp1,Op1,3); I2C(SLL,Tmp2,Op1,2); I3(ADDU,Result,Tmp1,Tmp2); I3(ADDU,Result,Result,Op1); break;
  343. case 14: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,1); I3(SUBU,Result,Tmp1,Tmp2); break; 
  344. case 15: I2C(SLL,Tmp1,Op1,4); I3(SUBU,Result,Tmp1,Op1); break;
  345. case 16: I2C(SLL,Result,Op1,4); break;
  346. case 17: I2C(SLL,Tmp1,Op1,4); I3(ADDU,Result,Tmp1,Op1); break;
  347. case 18: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,1); I3(ADDU,Result,Tmp1,Tmp2); break;
  348. case 19: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,1); I3(ADDU,Result,Tmp1,Tmp2); I3(ADDU,Result,Result,Op1); break;
  349. case 20: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,2); I3(ADDU,Result,Tmp1,Tmp2); break;
  350. case 21: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,2); I3(ADDU,Result,Tmp1,Tmp2); I3(ADDU,Result,Result,Op1); break;
  351. case 22: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,2); I3(ADDU,Result,Tmp1,Tmp2); I3(ADDU,Result,Result,Op1); I3(ADDU,Result,Result,Op1); break;
  352. case 23: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,3); I3(ADDU,Result,Tmp1,Tmp2); I3(SUBU,Result,Result,Op1); break;
  353. case 24: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,3); I3(ADDU,Result,Tmp1,Tmp2); break;
  354. case 25: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,3); I3(ADDU,Result,Tmp1,Tmp2); I3(ADDU,Result,Result,Op1); break;
  355. case 26: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,3); I3(ADDU,Result,Tmp1,Tmp2); I3(ADDU,Result,Result,Op1); I3(ADDU,Result,Result,Op1); break;
  356. case 27: I2C(SLL,Tmp1,Op1,5); I2C(SLL,Tmp2,Op1,2); I3(SUBU,Result,Tmp1,Tmp2); I3(SUBU,Result,Result,Op1); break;
  357. case 28: I2C(SLL,Tmp1,Op1,5); I2C(SLL,Tmp2,Op1,2); I3(SUBU,Result,Tmp1,Tmp2); break;
  358. case 29: I2C(SLL,Tmp1,Op1,5); I2C(SLL,Tmp2,Op1,2); I3(SUBU,Result,Tmp1,Tmp2); I3(ADDU,Result,Result,Op1); break;
  359. case 30: I2C(SLL,Tmp1,Op1,5); I2C(SLL,Tmp2,Op1,1); I3(SUBU,Result,Tmp1,Tmp2); break;
  360. case 31: I2C(SLL,Tmp1,Op1,5); I3(SUBU,Result,Tmp1,Op1); break;
  361. default: I2C(SLL,Result,Op1,5); break;
  362. }
  363. else
  364. switch (Mul)
  365. {
  366. case -1: I3(SUBU,Result,ZERO,Op1); break;
  367. case -3: I2C(SLL,Tmp1,Op1,2); I3(SUBU,Result,Op1,Tmp1); break;
  368. case -6: I2C(SLL,Tmp1,Op1,1); I2C(SLL,Tmp2,Op1,3); I3(SUBU,Result,Tmp1,Tmp2); break;
  369. case -7: I2C(SLL,Tmp1,Op1,3); I3(SUBU,Result,Op1,Tmp1); break;
  370. case -11: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,2); I3(ADDU,Tmp2,Tmp2,Op1); I3(SUBU,Result,Tmp2,Tmp1); break;
  371. case -12: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,2); I3(SUBU,Result,Tmp2,Tmp1); break; 
  372. case -13: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,1); I3(ADDU,Tmp2,Tmp2,Op1); I3(SUBU,Result,Tmp2,Tmp1); break;
  373. case -14: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,1); I3(SUBU,Result,Tmp2,Tmp1); break; 
  374. case -15: I2C(SLL,Tmp1,Op1,4); I3(SUBU,Result,Op1,Tmp1); break;
  375. case -19: I2C(SLL,Tmp1,Op1,4); I2C(SLL,Tmp2,Op1,2); I3(SUBU,Result,Op1,Tmp1); I3(SUBU,Result,Result,Tmp2); break;
  377. default: 
  378. Result = IMul(Op1,-Mul,Tmp1,Tmp2,Tmp3,NULL);
  379. if (Neg)
  380.  *Neg = 1;
  381. else
  382. I3(SUBU,Result,ZERO,Result); 
  383. break;
  384. }
  386. return Result;
  387. }
  389. #endif