x86_emulate.c 38 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445
  1. /******************************************************************************
  2. * x86_emulate.c
  3. *
  4. * Generic x86 (32-bit and 64-bit) instruction decoder and emulator.
  5. *
  6. * Copyright (c) 2005 Keir Fraser
  7. *
  8. * Linux coding style, mod r/m decoder, segment base fixes, real-mode
  9. * privileged instructions:
  10. *
  11. * Copyright (C) 2006 Qumranet
  12. *
  13. * Avi Kivity <avi@qumranet.com>
  14. * Yaniv Kamay <yaniv@qumranet.com>
  15. *
  16. * This work is licensed under the terms of the GNU GPL, version 2. See
  17. * the COPYING file in the top-level directory.
  18. *
  19. * From: xen-unstable 10676:af9809f51f81a3c43f276f00c81a52ef558afda4
  20. */
  21. #ifndef __KERNEL__
  22. #include <stdio.h>
  23. #include <stdint.h>
  24. #include <public/xen.h>
  25. #define DPRINTF(_f, _a ...) printf( _f , ## _a )
  26. #else
  27. #include "kvm.h"
  28. #define DPRINTF(x...) do {} while (0)
  29. #endif
  30. #include "x86_emulate.h"
  31. #include <linux/module.h>
  32. /*
  33. * Opcode effective-address decode tables.
  34. * Note that we only emulate instructions that have at least one memory
  35. * operand (excluding implicit stack references). We assume that stack
  36. * references and instruction fetches will never occur in special memory
  37. * areas that require emulation. So, for example, 'mov <imm>,<reg>' need
  38. * not be handled.
  39. */
  40. /* Operand sizes: 8-bit operands or specified/overridden size. */
  41. #define ByteOp (1<<0) /* 8-bit operands. */
  42. /* Destination operand type. */
  43. #define ImplicitOps (1<<1) /* Implicit in opcode. No generic decode. */
  44. #define DstReg (2<<1) /* Register operand. */
  45. #define DstMem (3<<1) /* Memory operand. */
  46. #define DstMask (3<<1)
  47. /* Source operand type. */
  48. #define SrcNone (0<<3) /* No source operand. */
  49. #define SrcImplicit (0<<3) /* Source operand is implicit in the opcode. */
  50. #define SrcReg (1<<3) /* Register operand. */
  51. #define SrcMem (2<<3) /* Memory operand. */
  52. #define SrcMem16 (3<<3) /* Memory operand (16-bit). */
  53. #define SrcMem32 (4<<3) /* Memory operand (32-bit). */
  54. #define SrcImm (5<<3) /* Immediate operand. */
  55. #define SrcImmByte (6<<3) /* 8-bit sign-extended immediate operand. */
  56. #define SrcMask (7<<3)
  57. /* Generic ModRM decode. */
  58. #define ModRM (1<<6)
  59. /* Destination is only written; never read. */
  60. #define Mov (1<<7)
  61. #define BitOp (1<<8)
  62. static u8 opcode_table[256] = {
  63. /* 0x00 - 0x07 */
  64. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  65. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  66. 0, 0, 0, 0,
  67. /* 0x08 - 0x0F */
  68. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  69. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  70. 0, 0, 0, 0,
  71. /* 0x10 - 0x17 */
  72. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  73. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  74. 0, 0, 0, 0,
  75. /* 0x18 - 0x1F */
  76. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  77. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  78. 0, 0, 0, 0,
  79. /* 0x20 - 0x27 */
  80. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  81. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  82. 0, 0, 0, 0,
  83. /* 0x28 - 0x2F */
  84. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  85. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  86. 0, 0, 0, 0,
  87. /* 0x30 - 0x37 */
  88. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  89. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  90. 0, 0, 0, 0,
  91. /* 0x38 - 0x3F */
  92. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  93. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  94. 0, 0, 0, 0,
  95. /* 0x40 - 0x4F */
  96. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  97. /* 0x50 - 0x57 */
  98. 0, 0, 0, 0, 0, 0, 0, 0,
  99. /* 0x58 - 0x5F */
  100. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  101. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  102. /* 0x60 - 0x6F */
  103. 0, 0, 0, DstReg | SrcMem32 | ModRM | Mov /* movsxd (x86/64) */ ,
  104. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  105. /* 0x70 - 0x7F */
  106. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  107. /* 0x80 - 0x87 */
  108. ByteOp | DstMem | SrcImm | ModRM, DstMem | SrcImm | ModRM,
  109. ByteOp | DstMem | SrcImm | ModRM, DstMem | SrcImmByte | ModRM,
  110. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  111. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  112. /* 0x88 - 0x8F */
  113. ByteOp | DstMem | SrcReg | ModRM | Mov, DstMem | SrcReg | ModRM | Mov,
  114. ByteOp | DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  115. 0, 0, 0, DstMem | SrcNone | ModRM | Mov,
  116. /* 0x90 - 0x9F */
  117. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  118. /* 0xA0 - 0xA7 */
  119. ByteOp | DstReg | SrcMem | Mov, DstReg | SrcMem | Mov,
  120. ByteOp | DstMem | SrcReg | Mov, DstMem | SrcReg | Mov,
  121. ByteOp | ImplicitOps | Mov, ImplicitOps | Mov,
  122. ByteOp | ImplicitOps, ImplicitOps,
  123. /* 0xA8 - 0xAF */
  124. 0, 0, ByteOp | ImplicitOps | Mov, ImplicitOps | Mov,
  125. ByteOp | ImplicitOps | Mov, ImplicitOps | Mov,
  126. ByteOp | ImplicitOps, ImplicitOps,
  127. /* 0xB0 - 0xBF */
  128. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  129. /* 0xC0 - 0xC7 */
  130. ByteOp | DstMem | SrcImm | ModRM, DstMem | SrcImmByte | ModRM,
  131. 0, ImplicitOps, 0, 0,
  132. ByteOp | DstMem | SrcImm | ModRM | Mov, DstMem | SrcImm | ModRM | Mov,
  133. /* 0xC8 - 0xCF */
  134. 0, 0, 0, 0, 0, 0, 0, 0,
  135. /* 0xD0 - 0xD7 */
  136. ByteOp | DstMem | SrcImplicit | ModRM, DstMem | SrcImplicit | ModRM,
  137. ByteOp | DstMem | SrcImplicit | ModRM, DstMem | SrcImplicit | ModRM,
  138. 0, 0, 0, 0,
  139. /* 0xD8 - 0xDF */
  140. 0, 0, 0, 0, 0, 0, 0, 0,
  141. /* 0xE0 - 0xEF */
  142. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  143. /* 0xF0 - 0xF7 */
  144. 0, 0, 0, 0,
  145. ImplicitOps, 0,
  146. ByteOp | DstMem | SrcNone | ModRM, DstMem | SrcNone | ModRM,
  147. /* 0xF8 - 0xFF */
  148. 0, 0, 0, 0,
  149. 0, 0, ByteOp | DstMem | SrcNone | ModRM, DstMem | SrcNone | ModRM
  150. };
  151. static u16 twobyte_table[256] = {
  152. /* 0x00 - 0x0F */
  153. 0, SrcMem | ModRM | DstReg, 0, 0, 0, 0, ImplicitOps, 0,
  154. 0, ImplicitOps, 0, 0, 0, ImplicitOps | ModRM, 0, 0,
  155. /* 0x10 - 0x1F */
  156. 0, 0, 0, 0, 0, 0, 0, 0, ImplicitOps | ModRM, 0, 0, 0, 0, 0, 0, 0,
  157. /* 0x20 - 0x2F */
  158. ModRM | ImplicitOps, ModRM, ModRM | ImplicitOps, ModRM, 0, 0, 0, 0,
  159. 0, 0, 0, 0, 0, 0, 0, 0,
  160. /* 0x30 - 0x3F */
  161. ImplicitOps, 0, ImplicitOps, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  162. /* 0x40 - 0x47 */
  163. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  164. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  165. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  166. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  167. /* 0x48 - 0x4F */
  168. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  169. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  170. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  171. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  172. /* 0x50 - 0x5F */
  173. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  174. /* 0x60 - 0x6F */
  175. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  176. /* 0x70 - 0x7F */
  177. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  178. /* 0x80 - 0x8F */
  179. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  180. /* 0x90 - 0x9F */
  181. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  182. /* 0xA0 - 0xA7 */
  183. 0, 0, 0, DstMem | SrcReg | ModRM | BitOp, 0, 0, 0, 0,
  184. /* 0xA8 - 0xAF */
  185. 0, 0, 0, DstMem | SrcReg | ModRM | BitOp, 0, 0, 0, 0,
  186. /* 0xB0 - 0xB7 */
  187. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM, 0,
  188. DstMem | SrcReg | ModRM | BitOp,
  189. 0, 0, ByteOp | DstReg | SrcMem | ModRM | Mov,
  190. DstReg | SrcMem16 | ModRM | Mov,
  191. /* 0xB8 - 0xBF */
  192. 0, 0, DstMem | SrcImmByte | ModRM, DstMem | SrcReg | ModRM | BitOp,
  193. 0, 0, ByteOp | DstReg | SrcMem | ModRM | Mov,
  194. DstReg | SrcMem16 | ModRM | Mov,
  195. /* 0xC0 - 0xCF */
  196. 0, 0, 0, 0, 0, 0, 0, ImplicitOps | ModRM, 0, 0, 0, 0, 0, 0, 0, 0,
  197. /* 0xD0 - 0xDF */
  198. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  199. /* 0xE0 - 0xEF */
  200. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  201. /* 0xF0 - 0xFF */
  202. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
  203. };
  204. /*
  205. * Tell the emulator that of the Group 7 instructions (sgdt, lidt, etc.) we
  206. * are interested only in invlpg and not in any of the rest.
  207. *
  208. * invlpg is a special instruction in that the data it references may not
  209. * be mapped.
  210. */
  211. void kvm_emulator_want_group7_invlpg(void)
  212. {
  213. twobyte_table[1] &= ~SrcMem;
  214. }
  215. EXPORT_SYMBOL_GPL(kvm_emulator_want_group7_invlpg);
  216. /* Type, address-of, and value of an instruction's operand. */
  217. struct operand {
  218. enum { OP_REG, OP_MEM, OP_IMM } type;
  219. unsigned int bytes;
  220. unsigned long val, orig_val, *ptr;
  221. };
  222. /* EFLAGS bit definitions. */
  223. #define EFLG_OF (1<<11)
  224. #define EFLG_DF (1<<10)
  225. #define EFLG_SF (1<<7)
  226. #define EFLG_ZF (1<<6)
  227. #define EFLG_AF (1<<4)
  228. #define EFLG_PF (1<<2)
  229. #define EFLG_CF (1<<0)
  230. /*
  231. * Instruction emulation:
  232. * Most instructions are emulated directly via a fragment of inline assembly
  233. * code. This allows us to save/restore EFLAGS and thus very easily pick up
  234. * any modified flags.
  235. */
  236. #if defined(CONFIG_X86_64)
  237. #define _LO32 "k" /* force 32-bit operand */
  238. #define _STK "%%rsp" /* stack pointer */
  239. #elif defined(__i386__)
  240. #define _LO32 "" /* force 32-bit operand */
  241. #define _STK "%%esp" /* stack pointer */
  242. #endif
  243. /*
  244. * These EFLAGS bits are restored from saved value during emulation, and
  245. * any changes are written back to the saved value after emulation.
  246. */
  247. #define EFLAGS_MASK (EFLG_OF|EFLG_SF|EFLG_ZF|EFLG_AF|EFLG_PF|EFLG_CF)
  248. /* Before executing instruction: restore necessary bits in EFLAGS. */
  249. #define _PRE_EFLAGS(_sav, _msk, _tmp) \
  250. /* EFLAGS = (_sav & _msk) | (EFLAGS & ~_msk); */ \
  251. "push %"_sav"; " \
  252. "movl %"_msk",%"_LO32 _tmp"; " \
  253. "andl %"_LO32 _tmp",("_STK"); " \
  254. "pushf; " \
  255. "notl %"_LO32 _tmp"; " \
  256. "andl %"_LO32 _tmp",("_STK"); " \
  257. "pop %"_tmp"; " \
  258. "orl %"_LO32 _tmp",("_STK"); " \
  259. "popf; " \
  260. /* _sav &= ~msk; */ \
  261. "movl %"_msk",%"_LO32 _tmp"; " \
  262. "notl %"_LO32 _tmp"; " \
  263. "andl %"_LO32 _tmp",%"_sav"; "
  264. /* After executing instruction: write-back necessary bits in EFLAGS. */
  265. #define _POST_EFLAGS(_sav, _msk, _tmp) \
  266. /* _sav |= EFLAGS & _msk; */ \
  267. "pushf; " \
  268. "pop %"_tmp"; " \
  269. "andl %"_msk",%"_LO32 _tmp"; " \
  270. "orl %"_LO32 _tmp",%"_sav"; "
  271. /* Raw emulation: instruction has two explicit operands. */
  272. #define __emulate_2op_nobyte(_op,_src,_dst,_eflags,_wx,_wy,_lx,_ly,_qx,_qy) \
  273. do { \
  274. unsigned long _tmp; \
  275. \
  276. switch ((_dst).bytes) { \
  277. case 2: \
  278. __asm__ __volatile__ ( \
  279. _PRE_EFLAGS("0","4","2") \
  280. _op"w %"_wx"3,%1; " \
  281. _POST_EFLAGS("0","4","2") \
  282. : "=m" (_eflags), "=m" ((_dst).val), \
  283. "=&r" (_tmp) \
  284. : _wy ((_src).val), "i" (EFLAGS_MASK) ); \
  285. break; \
  286. case 4: \
  287. __asm__ __volatile__ ( \
  288. _PRE_EFLAGS("0","4","2") \
  289. _op"l %"_lx"3,%1; " \
  290. _POST_EFLAGS("0","4","2") \
  291. : "=m" (_eflags), "=m" ((_dst).val), \
  292. "=&r" (_tmp) \
  293. : _ly ((_src).val), "i" (EFLAGS_MASK) ); \
  294. break; \
  295. case 8: \
  296. __emulate_2op_8byte(_op, _src, _dst, \
  297. _eflags, _qx, _qy); \
  298. break; \
  299. } \
  300. } while (0)
  301. #define __emulate_2op(_op,_src,_dst,_eflags,_bx,_by,_wx,_wy,_lx,_ly,_qx,_qy) \
  302. do { \
  303. unsigned long _tmp; \
  304. switch ( (_dst).bytes ) \
  305. { \
  306. case 1: \
  307. __asm__ __volatile__ ( \
  308. _PRE_EFLAGS("0","4","2") \
  309. _op"b %"_bx"3,%1; " \
  310. _POST_EFLAGS("0","4","2") \
  311. : "=m" (_eflags), "=m" ((_dst).val), \
  312. "=&r" (_tmp) \
  313. : _by ((_src).val), "i" (EFLAGS_MASK) ); \
  314. break; \
  315. default: \
  316. __emulate_2op_nobyte(_op, _src, _dst, _eflags, \
  317. _wx, _wy, _lx, _ly, _qx, _qy); \
  318. break; \
  319. } \
  320. } while (0)
  321. /* Source operand is byte-sized and may be restricted to just %cl. */
  322. #define emulate_2op_SrcB(_op, _src, _dst, _eflags) \
  323. __emulate_2op(_op, _src, _dst, _eflags, \
  324. "b", "c", "b", "c", "b", "c", "b", "c")
  325. /* Source operand is byte, word, long or quad sized. */
  326. #define emulate_2op_SrcV(_op, _src, _dst, _eflags) \
  327. __emulate_2op(_op, _src, _dst, _eflags, \
  328. "b", "q", "w", "r", _LO32, "r", "", "r")
  329. /* Source operand is word, long or quad sized. */
  330. #define emulate_2op_SrcV_nobyte(_op, _src, _dst, _eflags) \
  331. __emulate_2op_nobyte(_op, _src, _dst, _eflags, \
  332. "w", "r", _LO32, "r", "", "r")
  333. /* Instruction has only one explicit operand (no source operand). */
  334. #define emulate_1op(_op, _dst, _eflags) \
  335. do { \
  336. unsigned long _tmp; \
  337. \
  338. switch ( (_dst).bytes ) \
  339. { \
  340. case 1: \
  341. __asm__ __volatile__ ( \
  342. _PRE_EFLAGS("0","3","2") \
  343. _op"b %1; " \
  344. _POST_EFLAGS("0","3","2") \
  345. : "=m" (_eflags), "=m" ((_dst).val), \
  346. "=&r" (_tmp) \
  347. : "i" (EFLAGS_MASK) ); \
  348. break; \
  349. case 2: \
  350. __asm__ __volatile__ ( \
  351. _PRE_EFLAGS("0","3","2") \
  352. _op"w %1; " \
  353. _POST_EFLAGS("0","3","2") \
  354. : "=m" (_eflags), "=m" ((_dst).val), \
  355. "=&r" (_tmp) \
  356. : "i" (EFLAGS_MASK) ); \
  357. break; \
  358. case 4: \
  359. __asm__ __volatile__ ( \
  360. _PRE_EFLAGS("0","3","2") \
  361. _op"l %1; " \
  362. _POST_EFLAGS("0","3","2") \
  363. : "=m" (_eflags), "=m" ((_dst).val), \
  364. "=&r" (_tmp) \
  365. : "i" (EFLAGS_MASK) ); \
  366. break; \
  367. case 8: \
  368. __emulate_1op_8byte(_op, _dst, _eflags); \
  369. break; \
  370. } \
  371. } while (0)
  372. /* Emulate an instruction with quadword operands (x86/64 only). */
  373. #if defined(CONFIG_X86_64)
  374. #define __emulate_2op_8byte(_op, _src, _dst, _eflags, _qx, _qy) \
  375. do { \
  376. __asm__ __volatile__ ( \
  377. _PRE_EFLAGS("0","4","2") \
  378. _op"q %"_qx"3,%1; " \
  379. _POST_EFLAGS("0","4","2") \
  380. : "=m" (_eflags), "=m" ((_dst).val), "=&r" (_tmp) \
  381. : _qy ((_src).val), "i" (EFLAGS_MASK) ); \
  382. } while (0)
  383. #define __emulate_1op_8byte(_op, _dst, _eflags) \
  384. do { \
  385. __asm__ __volatile__ ( \
  386. _PRE_EFLAGS("0","3","2") \
  387. _op"q %1; " \
  388. _POST_EFLAGS("0","3","2") \
  389. : "=m" (_eflags), "=m" ((_dst).val), "=&r" (_tmp) \
  390. : "i" (EFLAGS_MASK) ); \
  391. } while (0)
  392. #elif defined(__i386__)
  393. #define __emulate_2op_8byte(_op, _src, _dst, _eflags, _qx, _qy)
  394. #define __emulate_1op_8byte(_op, _dst, _eflags)
  395. #endif /* __i386__ */
  396. /* Fetch next part of the instruction being emulated. */
  397. #define insn_fetch(_type, _size, _eip) \
  398. ({ unsigned long _x; \
  399. rc = ops->read_std((unsigned long)(_eip) + ctxt->cs_base, &_x, \
  400. (_size), ctxt); \
  401. if ( rc != 0 ) \
  402. goto done; \
  403. (_eip) += (_size); \
  404. (_type)_x; \
  405. })
  406. /* Access/update address held in a register, based on addressing mode. */
  407. #define register_address(base, reg) \
  408. ((base) + ((ad_bytes == sizeof(unsigned long)) ? (reg) : \
  409. ((reg) & ((1UL << (ad_bytes << 3)) - 1))))
  410. #define register_address_increment(reg, inc) \
  411. do { \
  412. /* signed type ensures sign extension to long */ \
  413. int _inc = (inc); \
  414. if ( ad_bytes == sizeof(unsigned long) ) \
  415. (reg) += _inc; \
  416. else \
  417. (reg) = ((reg) & ~((1UL << (ad_bytes << 3)) - 1)) | \
  418. (((reg) + _inc) & ((1UL << (ad_bytes << 3)) - 1)); \
  419. } while (0)
  420. /*
  421. * Given the 'reg' portion of a ModRM byte, and a register block, return a
  422. * pointer into the block that addresses the relevant register.
  423. * @highbyte_regs specifies whether to decode AH,CH,DH,BH.
  424. */
  425. static void *decode_register(u8 modrm_reg, unsigned long *regs,
  426. int highbyte_regs)
  427. {
  428. void *p;
  429. p = &regs[modrm_reg];
  430. if (highbyte_regs && modrm_reg >= 4 && modrm_reg < 8)
  431. p = (unsigned char *)&regs[modrm_reg & 3] + 1;
  432. return p;
  433. }
  434. static int read_descriptor(struct x86_emulate_ctxt *ctxt,
  435. struct x86_emulate_ops *ops,
  436. void *ptr,
  437. u16 *size, unsigned long *address, int op_bytes)
  438. {
  439. int rc;
  440. if (op_bytes == 2)
  441. op_bytes = 3;
  442. *address = 0;
  443. rc = ops->read_std((unsigned long)ptr, (unsigned long *)size, 2, ctxt);
  444. if (rc)
  445. return rc;
  446. rc = ops->read_std((unsigned long)ptr + 2, address, op_bytes, ctxt);
  447. return rc;
  448. }
  449. int
  450. x86_emulate_memop(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops)
  451. {
  452. unsigned d;
  453. u8 b, sib, twobyte = 0, rex_prefix = 0;
  454. u8 modrm, modrm_mod = 0, modrm_reg = 0, modrm_rm = 0;
  455. unsigned long *override_base = NULL;
  456. unsigned int op_bytes, ad_bytes, lock_prefix = 0, rep_prefix = 0, i;
  457. int rc = 0;
  458. struct operand src, dst;
  459. unsigned long cr2 = ctxt->cr2;
  460. int mode = ctxt->mode;
  461. unsigned long modrm_ea;
  462. int use_modrm_ea, index_reg = 0, base_reg = 0, scale, rip_relative = 0;
  463. int no_wb = 0;
  464. u64 msr_data;
  465. /* Shadow copy of register state. Committed on successful emulation. */
  466. unsigned long _regs[NR_VCPU_REGS];
  467. unsigned long _eip = ctxt->vcpu->rip, _eflags = ctxt->eflags;
  468. unsigned long modrm_val = 0;
  469. memcpy(_regs, ctxt->vcpu->regs, sizeof _regs);
  470. switch (mode) {
  471. case X86EMUL_MODE_REAL:
  472. case X86EMUL_MODE_PROT16:
  473. op_bytes = ad_bytes = 2;
  474. break;
  475. case X86EMUL_MODE_PROT32:
  476. op_bytes = ad_bytes = 4;
  477. break;
  478. #ifdef CONFIG_X86_64
  479. case X86EMUL_MODE_PROT64:
  480. op_bytes = 4;
  481. ad_bytes = 8;
  482. break;
  483. #endif
  484. default:
  485. return -1;
  486. }
  487. /* Legacy prefixes. */
  488. for (i = 0; i < 8; i++) {
  489. switch (b = insn_fetch(u8, 1, _eip)) {
  490. case 0x66: /* operand-size override */
  491. op_bytes ^= 6; /* switch between 2/4 bytes */
  492. break;
  493. case 0x67: /* address-size override */
  494. if (mode == X86EMUL_MODE_PROT64)
  495. ad_bytes ^= 12; /* switch between 4/8 bytes */
  496. else
  497. ad_bytes ^= 6; /* switch between 2/4 bytes */
  498. break;
  499. case 0x2e: /* CS override */
  500. override_base = &ctxt->cs_base;
  501. break;
  502. case 0x3e: /* DS override */
  503. override_base = &ctxt->ds_base;
  504. break;
  505. case 0x26: /* ES override */
  506. override_base = &ctxt->es_base;
  507. break;
  508. case 0x64: /* FS override */
  509. override_base = &ctxt->fs_base;
  510. break;
  511. case 0x65: /* GS override */
  512. override_base = &ctxt->gs_base;
  513. break;
  514. case 0x36: /* SS override */
  515. override_base = &ctxt->ss_base;
  516. break;
  517. case 0xf0: /* LOCK */
  518. lock_prefix = 1;
  519. break;
  520. case 0xf3: /* REP/REPE/REPZ */
  521. rep_prefix = 1;
  522. break;
  523. case 0xf2: /* REPNE/REPNZ */
  524. break;
  525. default:
  526. goto done_prefixes;
  527. }
  528. }
  529. done_prefixes:
  530. /* REX prefix. */
  531. if ((mode == X86EMUL_MODE_PROT64) && ((b & 0xf0) == 0x40)) {
  532. rex_prefix = b;
  533. if (b & 8)
  534. op_bytes = 8; /* REX.W */
  535. modrm_reg = (b & 4) << 1; /* REX.R */
  536. index_reg = (b & 2) << 2; /* REX.X */
  537. modrm_rm = base_reg = (b & 1) << 3; /* REG.B */
  538. b = insn_fetch(u8, 1, _eip);
  539. }
  540. /* Opcode byte(s). */
  541. d = opcode_table[b];
  542. if (d == 0) {
  543. /* Two-byte opcode? */
  544. if (b == 0x0f) {
  545. twobyte = 1;
  546. b = insn_fetch(u8, 1, _eip);
  547. d = twobyte_table[b];
  548. }
  549. /* Unrecognised? */
  550. if (d == 0)
  551. goto cannot_emulate;
  552. }
  553. /* ModRM and SIB bytes. */
  554. if (d & ModRM) {
  555. modrm = insn_fetch(u8, 1, _eip);
  556. modrm_mod |= (modrm & 0xc0) >> 6;
  557. modrm_reg |= (modrm & 0x38) >> 3;
  558. modrm_rm |= (modrm & 0x07);
  559. modrm_ea = 0;
  560. use_modrm_ea = 1;
  561. if (modrm_mod == 3) {
  562. modrm_val = *(unsigned long *)
  563. decode_register(modrm_rm, _regs, d & ByteOp);
  564. goto modrm_done;
  565. }
  566. if (ad_bytes == 2) {
  567. unsigned bx = _regs[VCPU_REGS_RBX];
  568. unsigned bp = _regs[VCPU_REGS_RBP];
  569. unsigned si = _regs[VCPU_REGS_RSI];
  570. unsigned di = _regs[VCPU_REGS_RDI];
  571. /* 16-bit ModR/M decode. */
  572. switch (modrm_mod) {
  573. case 0:
  574. if (modrm_rm == 6)
  575. modrm_ea += insn_fetch(u16, 2, _eip);
  576. break;
  577. case 1:
  578. modrm_ea += insn_fetch(s8, 1, _eip);
  579. break;
  580. case 2:
  581. modrm_ea += insn_fetch(u16, 2, _eip);
  582. break;
  583. }
  584. switch (modrm_rm) {
  585. case 0:
  586. modrm_ea += bx + si;
  587. break;
  588. case 1:
  589. modrm_ea += bx + di;
  590. break;
  591. case 2:
  592. modrm_ea += bp + si;
  593. break;
  594. case 3:
  595. modrm_ea += bp + di;
  596. break;
  597. case 4:
  598. modrm_ea += si;
  599. break;
  600. case 5:
  601. modrm_ea += di;
  602. break;
  603. case 6:
  604. if (modrm_mod != 0)
  605. modrm_ea += bp;
  606. break;
  607. case 7:
  608. modrm_ea += bx;
  609. break;
  610. }
  611. if (modrm_rm == 2 || modrm_rm == 3 ||
  612. (modrm_rm == 6 && modrm_mod != 0))
  613. if (!override_base)
  614. override_base = &ctxt->ss_base;
  615. modrm_ea = (u16)modrm_ea;
  616. } else {
  617. /* 32/64-bit ModR/M decode. */
  618. switch (modrm_rm) {
  619. case 4:
  620. case 12:
  621. sib = insn_fetch(u8, 1, _eip);
  622. index_reg |= (sib >> 3) & 7;
  623. base_reg |= sib & 7;
  624. scale = sib >> 6;
  625. switch (base_reg) {
  626. case 5:
  627. if (modrm_mod != 0)
  628. modrm_ea += _regs[base_reg];
  629. else
  630. modrm_ea += insn_fetch(s32, 4, _eip);
  631. break;
  632. default:
  633. modrm_ea += _regs[base_reg];
  634. }
  635. switch (index_reg) {
  636. case 4:
  637. break;
  638. default:
  639. modrm_ea += _regs[index_reg] << scale;
  640. }
  641. break;
  642. case 5:
  643. if (modrm_mod != 0)
  644. modrm_ea += _regs[modrm_rm];
  645. else if (mode == X86EMUL_MODE_PROT64)
  646. rip_relative = 1;
  647. break;
  648. default:
  649. modrm_ea += _regs[modrm_rm];
  650. break;
  651. }
  652. switch (modrm_mod) {
  653. case 0:
  654. if (modrm_rm == 5)
  655. modrm_ea += insn_fetch(s32, 4, _eip);
  656. break;
  657. case 1:
  658. modrm_ea += insn_fetch(s8, 1, _eip);
  659. break;
  660. case 2:
  661. modrm_ea += insn_fetch(s32, 4, _eip);
  662. break;
  663. }
  664. }
  665. if (!override_base)
  666. override_base = &ctxt->ds_base;
  667. if (mode == X86EMUL_MODE_PROT64 &&
  668. override_base != &ctxt->fs_base &&
  669. override_base != &ctxt->gs_base)
  670. override_base = NULL;
  671. if (override_base)
  672. modrm_ea += *override_base;
  673. if (rip_relative) {
  674. modrm_ea += _eip;
  675. switch (d & SrcMask) {
  676. case SrcImmByte:
  677. modrm_ea += 1;
  678. break;
  679. case SrcImm:
  680. if (d & ByteOp)
  681. modrm_ea += 1;
  682. else
  683. if (op_bytes == 8)
  684. modrm_ea += 4;
  685. else
  686. modrm_ea += op_bytes;
  687. }
  688. }
  689. if (ad_bytes != 8)
  690. modrm_ea = (u32)modrm_ea;
  691. cr2 = modrm_ea;
  692. modrm_done:
  693. ;
  694. }
  695. /*
  696. * Decode and fetch the source operand: register, memory
  697. * or immediate.
  698. */
  699. switch (d & SrcMask) {
  700. case SrcNone:
  701. break;
  702. case SrcReg:
  703. src.type = OP_REG;
  704. if (d & ByteOp) {
  705. src.ptr = decode_register(modrm_reg, _regs,
  706. (rex_prefix == 0));
  707. src.val = src.orig_val = *(u8 *) src.ptr;
  708. src.bytes = 1;
  709. } else {
  710. src.ptr = decode_register(modrm_reg, _regs, 0);
  711. switch ((src.bytes = op_bytes)) {
  712. case 2:
  713. src.val = src.orig_val = *(u16 *) src.ptr;
  714. break;
  715. case 4:
  716. src.val = src.orig_val = *(u32 *) src.ptr;
  717. break;
  718. case 8:
  719. src.val = src.orig_val = *(u64 *) src.ptr;
  720. break;
  721. }
  722. }
  723. break;
  724. case SrcMem16:
  725. src.bytes = 2;
  726. goto srcmem_common;
  727. case SrcMem32:
  728. src.bytes = 4;
  729. goto srcmem_common;
  730. case SrcMem:
  731. src.bytes = (d & ByteOp) ? 1 : op_bytes;
  732. srcmem_common:
  733. src.type = OP_MEM;
  734. src.ptr = (unsigned long *)cr2;
  735. if ((rc = ops->read_emulated((unsigned long)src.ptr,
  736. &src.val, src.bytes, ctxt)) != 0)
  737. goto done;
  738. src.orig_val = src.val;
  739. break;
  740. case SrcImm:
  741. src.type = OP_IMM;
  742. src.ptr = (unsigned long *)_eip;
  743. src.bytes = (d & ByteOp) ? 1 : op_bytes;
  744. if (src.bytes == 8)
  745. src.bytes = 4;
  746. /* NB. Immediates are sign-extended as necessary. */
  747. switch (src.bytes) {
  748. case 1:
  749. src.val = insn_fetch(s8, 1, _eip);
  750. break;
  751. case 2:
  752. src.val = insn_fetch(s16, 2, _eip);
  753. break;
  754. case 4:
  755. src.val = insn_fetch(s32, 4, _eip);
  756. break;
  757. }
  758. break;
  759. case SrcImmByte:
  760. src.type = OP_IMM;
  761. src.ptr = (unsigned long *)_eip;
  762. src.bytes = 1;
  763. src.val = insn_fetch(s8, 1, _eip);
  764. break;
  765. }
  766. /* Decode and fetch the destination operand: register or memory. */
  767. switch (d & DstMask) {
  768. case ImplicitOps:
  769. /* Special instructions do their own operand decoding. */
  770. goto special_insn;
  771. case DstReg:
  772. dst.type = OP_REG;
  773. if ((d & ByteOp)
  774. && !(twobyte && (b == 0xb6 || b == 0xb7))) {
  775. dst.ptr = decode_register(modrm_reg, _regs,
  776. (rex_prefix == 0));
  777. dst.val = *(u8 *) dst.ptr;
  778. dst.bytes = 1;
  779. } else {
  780. dst.ptr = decode_register(modrm_reg, _regs, 0);
  781. switch ((dst.bytes = op_bytes)) {
  782. case 2:
  783. dst.val = *(u16 *)dst.ptr;
  784. break;
  785. case 4:
  786. dst.val = *(u32 *)dst.ptr;
  787. break;
  788. case 8:
  789. dst.val = *(u64 *)dst.ptr;
  790. break;
  791. }
  792. }
  793. break;
  794. case DstMem:
  795. dst.type = OP_MEM;
  796. dst.ptr = (unsigned long *)cr2;
  797. dst.bytes = (d & ByteOp) ? 1 : op_bytes;
  798. if (d & BitOp) {
  799. unsigned long mask = ~(dst.bytes * 8 - 1);
  800. dst.ptr = (void *)dst.ptr + (src.val & mask) / 8;
  801. }
  802. if (!(d & Mov) && /* optimisation - avoid slow emulated read */
  803. ((rc = ops->read_emulated((unsigned long)dst.ptr,
  804. &dst.val, dst.bytes, ctxt)) != 0))
  805. goto done;
  806. break;
  807. }
  808. dst.orig_val = dst.val;
  809. if (twobyte)
  810. goto twobyte_insn;
  811. switch (b) {
  812. case 0x00 ... 0x05:
  813. add: /* add */
  814. emulate_2op_SrcV("add", src, dst, _eflags);
  815. break;
  816. case 0x08 ... 0x0d:
  817. or: /* or */
  818. emulate_2op_SrcV("or", src, dst, _eflags);
  819. break;
  820. case 0x10 ... 0x15:
  821. adc: /* adc */
  822. emulate_2op_SrcV("adc", src, dst, _eflags);
  823. break;
  824. case 0x18 ... 0x1d:
  825. sbb: /* sbb */
  826. emulate_2op_SrcV("sbb", src, dst, _eflags);
  827. break;
  828. case 0x20 ... 0x25:
  829. and: /* and */
  830. emulate_2op_SrcV("and", src, dst, _eflags);
  831. break;
  832. case 0x28 ... 0x2d:
  833. sub: /* sub */
  834. emulate_2op_SrcV("sub", src, dst, _eflags);
  835. break;
  836. case 0x30 ... 0x35:
  837. xor: /* xor */
  838. emulate_2op_SrcV("xor", src, dst, _eflags);
  839. break;
  840. case 0x38 ... 0x3d:
  841. cmp: /* cmp */
  842. emulate_2op_SrcV("cmp", src, dst, _eflags);
  843. break;
  844. case 0x63: /* movsxd */
  845. if (mode != X86EMUL_MODE_PROT64)
  846. goto cannot_emulate;
  847. dst.val = (s32) src.val;
  848. break;
  849. case 0x80 ... 0x83: /* Grp1 */
  850. switch (modrm_reg) {
  851. case 0:
  852. goto add;
  853. case 1:
  854. goto or;
  855. case 2:
  856. goto adc;
  857. case 3:
  858. goto sbb;
  859. case 4:
  860. goto and;
  861. case 5:
  862. goto sub;
  863. case 6:
  864. goto xor;
  865. case 7:
  866. goto cmp;
  867. }
  868. break;
  869. case 0x84 ... 0x85:
  870. test: /* test */
  871. emulate_2op_SrcV("test", src, dst, _eflags);
  872. break;
  873. case 0x86 ... 0x87: /* xchg */
  874. /* Write back the register source. */
  875. switch (dst.bytes) {
  876. case 1:
  877. *(u8 *) src.ptr = (u8) dst.val;
  878. break;
  879. case 2:
  880. *(u16 *) src.ptr = (u16) dst.val;
  881. break;
  882. case 4:
  883. *src.ptr = (u32) dst.val;
  884. break; /* 64b reg: zero-extend */
  885. case 8:
  886. *src.ptr = dst.val;
  887. break;
  888. }
  889. /*
  890. * Write back the memory destination with implicit LOCK
  891. * prefix.
  892. */
  893. dst.val = src.val;
  894. lock_prefix = 1;
  895. break;
  896. case 0xa0 ... 0xa1: /* mov */
  897. dst.ptr = (unsigned long *)&_regs[VCPU_REGS_RAX];
  898. dst.val = src.val;
  899. _eip += ad_bytes; /* skip src displacement */
  900. break;
  901. case 0xa2 ... 0xa3: /* mov */
  902. dst.val = (unsigned long)_regs[VCPU_REGS_RAX];
  903. _eip += ad_bytes; /* skip dst displacement */
  904. break;
  905. case 0x88 ... 0x8b: /* mov */
  906. case 0xc6 ... 0xc7: /* mov (sole member of Grp11) */
  907. dst.val = src.val;
  908. break;
  909. case 0x8f: /* pop (sole member of Grp1a) */
  910. /* 64-bit mode: POP always pops a 64-bit operand. */
  911. if (mode == X86EMUL_MODE_PROT64)
  912. dst.bytes = 8;
  913. if ((rc = ops->read_std(register_address(ctxt->ss_base,
  914. _regs[VCPU_REGS_RSP]),
  915. &dst.val, dst.bytes, ctxt)) != 0)
  916. goto done;
  917. register_address_increment(_regs[VCPU_REGS_RSP], dst.bytes);
  918. break;
  919. case 0xc0 ... 0xc1:
  920. grp2: /* Grp2 */
  921. switch (modrm_reg) {
  922. case 0: /* rol */
  923. emulate_2op_SrcB("rol", src, dst, _eflags);
  924. break;
  925. case 1: /* ror */
  926. emulate_2op_SrcB("ror", src, dst, _eflags);
  927. break;
  928. case 2: /* rcl */
  929. emulate_2op_SrcB("rcl", src, dst, _eflags);
  930. break;
  931. case 3: /* rcr */
  932. emulate_2op_SrcB("rcr", src, dst, _eflags);
  933. break;
  934. case 4: /* sal/shl */
  935. case 6: /* sal/shl */
  936. emulate_2op_SrcB("sal", src, dst, _eflags);
  937. break;
  938. case 5: /* shr */
  939. emulate_2op_SrcB("shr", src, dst, _eflags);
  940. break;
  941. case 7: /* sar */
  942. emulate_2op_SrcB("sar", src, dst, _eflags);
  943. break;
  944. }
  945. break;
  946. case 0xd0 ... 0xd1: /* Grp2 */
  947. src.val = 1;
  948. goto grp2;
  949. case 0xd2 ... 0xd3: /* Grp2 */
  950. src.val = _regs[VCPU_REGS_RCX];
  951. goto grp2;
  952. case 0xf6 ... 0xf7: /* Grp3 */
  953. switch (modrm_reg) {
  954. case 0 ... 1: /* test */
  955. /*
  956. * Special case in Grp3: test has an immediate
  957. * source operand.
  958. */
  959. src.type = OP_IMM;
  960. src.ptr = (unsigned long *)_eip;
  961. src.bytes = (d & ByteOp) ? 1 : op_bytes;
  962. if (src.bytes == 8)
  963. src.bytes = 4;
  964. switch (src.bytes) {
  965. case 1:
  966. src.val = insn_fetch(s8, 1, _eip);
  967. break;
  968. case 2:
  969. src.val = insn_fetch(s16, 2, _eip);
  970. break;
  971. case 4:
  972. src.val = insn_fetch(s32, 4, _eip);
  973. break;
  974. }
  975. goto test;
  976. case 2: /* not */
  977. dst.val = ~dst.val;
  978. break;
  979. case 3: /* neg */
  980. emulate_1op("neg", dst, _eflags);
  981. break;
  982. default:
  983. goto cannot_emulate;
  984. }
  985. break;
  986. case 0xfe ... 0xff: /* Grp4/Grp5 */
  987. switch (modrm_reg) {
  988. case 0: /* inc */
  989. emulate_1op("inc", dst, _eflags);
  990. break;
  991. case 1: /* dec */
  992. emulate_1op("dec", dst, _eflags);
  993. break;
  994. case 6: /* push */
  995. /* 64-bit mode: PUSH always pushes a 64-bit operand. */
  996. if (mode == X86EMUL_MODE_PROT64) {
  997. dst.bytes = 8;
  998. if ((rc = ops->read_std((unsigned long)dst.ptr,
  999. &dst.val, 8,
  1000. ctxt)) != 0)
  1001. goto done;
  1002. }
  1003. register_address_increment(_regs[VCPU_REGS_RSP],
  1004. -dst.bytes);
  1005. if ((rc = ops->write_std(
  1006. register_address(ctxt->ss_base,
  1007. _regs[VCPU_REGS_RSP]),
  1008. &dst.val, dst.bytes, ctxt)) != 0)
  1009. goto done;
  1010. no_wb = 1;
  1011. break;
  1012. default:
  1013. goto cannot_emulate;
  1014. }
  1015. break;
  1016. }
  1017. writeback:
  1018. if (!no_wb) {
  1019. switch (dst.type) {
  1020. case OP_REG:
  1021. /* The 4-byte case *is* correct: in 64-bit mode we zero-extend. */
  1022. switch (dst.bytes) {
  1023. case 1:
  1024. *(u8 *)dst.ptr = (u8)dst.val;
  1025. break;
  1026. case 2:
  1027. *(u16 *)dst.ptr = (u16)dst.val;
  1028. break;
  1029. case 4:
  1030. *dst.ptr = (u32)dst.val;
  1031. break; /* 64b: zero-ext */
  1032. case 8:
  1033. *dst.ptr = dst.val;
  1034. break;
  1035. }
  1036. break;
  1037. case OP_MEM:
  1038. if (lock_prefix)
  1039. rc = ops->cmpxchg_emulated((unsigned long)dst.
  1040. ptr, &dst.orig_val,
  1041. &dst.val, dst.bytes,
  1042. ctxt);
  1043. else
  1044. rc = ops->write_emulated((unsigned long)dst.ptr,
  1045. &dst.val, dst.bytes,
  1046. ctxt);
  1047. if (rc != 0)
  1048. goto done;
  1049. default:
  1050. break;
  1051. }
  1052. }
  1053. /* Commit shadow register state. */
  1054. memcpy(ctxt->vcpu->regs, _regs, sizeof _regs);
  1055. ctxt->eflags = _eflags;
  1056. ctxt->vcpu->rip = _eip;
  1057. done:
  1058. return (rc == X86EMUL_UNHANDLEABLE) ? -1 : 0;
  1059. special_insn:
  1060. if (twobyte)
  1061. goto twobyte_special_insn;
  1062. if (rep_prefix) {
  1063. if (_regs[VCPU_REGS_RCX] == 0) {
  1064. ctxt->vcpu->rip = _eip;
  1065. goto done;
  1066. }
  1067. _regs[VCPU_REGS_RCX]--;
  1068. _eip = ctxt->vcpu->rip;
  1069. }
  1070. switch (b) {
  1071. case 0xa4 ... 0xa5: /* movs */
  1072. dst.type = OP_MEM;
  1073. dst.bytes = (d & ByteOp) ? 1 : op_bytes;
  1074. dst.ptr = (unsigned long *)register_address(ctxt->es_base,
  1075. _regs[VCPU_REGS_RDI]);
  1076. if ((rc = ops->read_emulated(register_address(
  1077. override_base ? *override_base : ctxt->ds_base,
  1078. _regs[VCPU_REGS_RSI]), &dst.val, dst.bytes, ctxt)) != 0)
  1079. goto done;
  1080. register_address_increment(_regs[VCPU_REGS_RSI],
  1081. (_eflags & EFLG_DF) ? -dst.bytes : dst.bytes);
  1082. register_address_increment(_regs[VCPU_REGS_RDI],
  1083. (_eflags & EFLG_DF) ? -dst.bytes : dst.bytes);
  1084. break;
  1085. case 0xa6 ... 0xa7: /* cmps */
  1086. DPRINTF("Urk! I don't handle CMPS.\n");
  1087. goto cannot_emulate;
  1088. case 0xaa ... 0xab: /* stos */
  1089. dst.type = OP_MEM;
  1090. dst.bytes = (d & ByteOp) ? 1 : op_bytes;
  1091. dst.ptr = (unsigned long *)cr2;
  1092. dst.val = _regs[VCPU_REGS_RAX];
  1093. register_address_increment(_regs[VCPU_REGS_RDI],
  1094. (_eflags & EFLG_DF) ? -dst.bytes : dst.bytes);
  1095. break;
  1096. case 0xac ... 0xad: /* lods */
  1097. dst.type = OP_REG;
  1098. dst.bytes = (d & ByteOp) ? 1 : op_bytes;
  1099. dst.ptr = (unsigned long *)&_regs[VCPU_REGS_RAX];
  1100. if ((rc = ops->read_emulated(cr2, &dst.val, dst.bytes, ctxt)) != 0)
  1101. goto done;
  1102. register_address_increment(_regs[VCPU_REGS_RSI],
  1103. (_eflags & EFLG_DF) ? -dst.bytes : dst.bytes);
  1104. break;
  1105. case 0xae ... 0xaf: /* scas */
  1106. DPRINTF("Urk! I don't handle SCAS.\n");
  1107. goto cannot_emulate;
  1108. case 0xf4: /* hlt */
  1109. ctxt->vcpu->halt_request = 1;
  1110. goto done;
  1111. case 0xc3: /* ret */
  1112. dst.ptr = &_eip;
  1113. goto pop_instruction;
  1114. case 0x58 ... 0x5f: /* pop reg */
  1115. dst.ptr = (unsigned long *)&_regs[b & 0x7];
  1116. pop_instruction:
  1117. if ((rc = ops->read_std(register_address(ctxt->ss_base,
  1118. _regs[VCPU_REGS_RSP]), dst.ptr, op_bytes, ctxt)) != 0)
  1119. goto done;
  1120. register_address_increment(_regs[VCPU_REGS_RSP], op_bytes);
  1121. no_wb = 1; /* Disable writeback. */
  1122. break;
  1123. }
  1124. goto writeback;
  1125. twobyte_insn:
  1126. switch (b) {
  1127. case 0x01: /* lgdt, lidt, lmsw */
  1128. /* Disable writeback. */
  1129. no_wb = 1;
  1130. switch (modrm_reg) {
  1131. u16 size;
  1132. unsigned long address;
  1133. case 2: /* lgdt */
  1134. rc = read_descriptor(ctxt, ops, src.ptr,
  1135. &size, &address, op_bytes);
  1136. if (rc)
  1137. goto done;
  1138. realmode_lgdt(ctxt->vcpu, size, address);
  1139. break;
  1140. case 3: /* lidt */
  1141. rc = read_descriptor(ctxt, ops, src.ptr,
  1142. &size, &address, op_bytes);
  1143. if (rc)
  1144. goto done;
  1145. realmode_lidt(ctxt->vcpu, size, address);
  1146. break;
  1147. case 4: /* smsw */
  1148. if (modrm_mod != 3)
  1149. goto cannot_emulate;
  1150. *(u16 *)&_regs[modrm_rm]
  1151. = realmode_get_cr(ctxt->vcpu, 0);
  1152. break;
  1153. case 6: /* lmsw */
  1154. if (modrm_mod != 3)
  1155. goto cannot_emulate;
  1156. realmode_lmsw(ctxt->vcpu, (u16)modrm_val, &_eflags);
  1157. break;
  1158. case 7: /* invlpg*/
  1159. emulate_invlpg(ctxt->vcpu, cr2);
  1160. break;
  1161. default:
  1162. goto cannot_emulate;
  1163. }
  1164. break;
  1165. case 0x21: /* mov from dr to reg */
  1166. no_wb = 1;
  1167. if (modrm_mod != 3)
  1168. goto cannot_emulate;
  1169. rc = emulator_get_dr(ctxt, modrm_reg, &_regs[modrm_rm]);
  1170. break;
  1171. case 0x23: /* mov from reg to dr */
  1172. no_wb = 1;
  1173. if (modrm_mod != 3)
  1174. goto cannot_emulate;
  1175. rc = emulator_set_dr(ctxt, modrm_reg, _regs[modrm_rm]);
  1176. break;
  1177. case 0x40 ... 0x4f: /* cmov */
  1178. dst.val = dst.orig_val = src.val;
  1179. no_wb = 1;
  1180. /*
  1181. * First, assume we're decoding an even cmov opcode
  1182. * (lsb == 0).
  1183. */
  1184. switch ((b & 15) >> 1) {
  1185. case 0: /* cmovo */
  1186. no_wb = (_eflags & EFLG_OF) ? 0 : 1;
  1187. break;
  1188. case 1: /* cmovb/cmovc/cmovnae */
  1189. no_wb = (_eflags & EFLG_CF) ? 0 : 1;
  1190. break;
  1191. case 2: /* cmovz/cmove */
  1192. no_wb = (_eflags & EFLG_ZF) ? 0 : 1;
  1193. break;
  1194. case 3: /* cmovbe/cmovna */
  1195. no_wb = (_eflags & (EFLG_CF | EFLG_ZF)) ? 0 : 1;
  1196. break;
  1197. case 4: /* cmovs */
  1198. no_wb = (_eflags & EFLG_SF) ? 0 : 1;
  1199. break;
  1200. case 5: /* cmovp/cmovpe */
  1201. no_wb = (_eflags & EFLG_PF) ? 0 : 1;
  1202. break;
  1203. case 7: /* cmovle/cmovng */
  1204. no_wb = (_eflags & EFLG_ZF) ? 0 : 1;
  1205. /* fall through */
  1206. case 6: /* cmovl/cmovnge */
  1207. no_wb &= (!(_eflags & EFLG_SF) !=
  1208. !(_eflags & EFLG_OF)) ? 0 : 1;
  1209. break;
  1210. }
  1211. /* Odd cmov opcodes (lsb == 1) have inverted sense. */
  1212. no_wb ^= b & 1;
  1213. break;
  1214. case 0xb0 ... 0xb1: /* cmpxchg */
  1215. /*
  1216. * Save real source value, then compare EAX against
  1217. * destination.
  1218. */
  1219. src.orig_val = src.val;
  1220. src.val = _regs[VCPU_REGS_RAX];
  1221. emulate_2op_SrcV("cmp", src, dst, _eflags);
  1222. /* Always write back. The question is: where to? */
  1223. d |= Mov;
  1224. if (_eflags & EFLG_ZF) {
  1225. /* Success: write back to memory. */
  1226. dst.val = src.orig_val;
  1227. } else {
  1228. /* Failure: write the value we saw to EAX. */
  1229. dst.type = OP_REG;
  1230. dst.ptr = (unsigned long *)&_regs[VCPU_REGS_RAX];
  1231. }
  1232. break;
  1233. case 0xa3:
  1234. bt: /* bt */
  1235. src.val &= (dst.bytes << 3) - 1; /* only subword offset */
  1236. emulate_2op_SrcV_nobyte("bt", src, dst, _eflags);
  1237. break;
  1238. case 0xb3:
  1239. btr: /* btr */
  1240. src.val &= (dst.bytes << 3) - 1; /* only subword offset */
  1241. emulate_2op_SrcV_nobyte("btr", src, dst, _eflags);
  1242. break;
  1243. case 0xab:
  1244. bts: /* bts */
  1245. src.val &= (dst.bytes << 3) - 1; /* only subword offset */
  1246. emulate_2op_SrcV_nobyte("bts", src, dst, _eflags);
  1247. break;
  1248. case 0xb6 ... 0xb7: /* movzx */
  1249. dst.bytes = op_bytes;
  1250. dst.val = (d & ByteOp) ? (u8) src.val : (u16) src.val;
  1251. break;
  1252. case 0xbb:
  1253. btc: /* btc */
  1254. src.val &= (dst.bytes << 3) - 1; /* only subword offset */
  1255. emulate_2op_SrcV_nobyte("btc", src, dst, _eflags);
  1256. break;
  1257. case 0xba: /* Grp8 */
  1258. switch (modrm_reg & 3) {
  1259. case 0:
  1260. goto bt;
  1261. case 1:
  1262. goto bts;
  1263. case 2:
  1264. goto btr;
  1265. case 3:
  1266. goto btc;
  1267. }
  1268. break;
  1269. case 0xbe ... 0xbf: /* movsx */
  1270. dst.bytes = op_bytes;
  1271. dst.val = (d & ByteOp) ? (s8) src.val : (s16) src.val;
  1272. break;
  1273. }
  1274. goto writeback;
  1275. twobyte_special_insn:
  1276. /* Disable writeback. */
  1277. no_wb = 1;
  1278. switch (b) {
  1279. case 0x09: /* wbinvd */
  1280. break;
  1281. case 0x0d: /* GrpP (prefetch) */
  1282. case 0x18: /* Grp16 (prefetch/nop) */
  1283. break;
  1284. case 0x06:
  1285. emulate_clts(ctxt->vcpu);
  1286. break;
  1287. case 0x20: /* mov cr, reg */
  1288. if (modrm_mod != 3)
  1289. goto cannot_emulate;
  1290. _regs[modrm_rm] = realmode_get_cr(ctxt->vcpu, modrm_reg);
  1291. break;
  1292. case 0x22: /* mov reg, cr */
  1293. if (modrm_mod != 3)
  1294. goto cannot_emulate;
  1295. realmode_set_cr(ctxt->vcpu, modrm_reg, modrm_val, &_eflags);
  1296. break;
  1297. case 0x30:
  1298. /* wrmsr */
  1299. msr_data = (u32)_regs[VCPU_REGS_RAX]
  1300. | ((u64)_regs[VCPU_REGS_RDX] << 32);
  1301. rc = kvm_set_msr(ctxt->vcpu, _regs[VCPU_REGS_RCX], msr_data);
  1302. if (rc) {
  1303. kvm_arch_ops->inject_gp(ctxt->vcpu, 0);
  1304. _eip = ctxt->vcpu->rip;
  1305. }
  1306. rc = X86EMUL_CONTINUE;
  1307. break;
  1308. case 0x32:
  1309. /* rdmsr */
  1310. rc = kvm_get_msr(ctxt->vcpu, _regs[VCPU_REGS_RCX], &msr_data);
  1311. if (rc) {
  1312. kvm_arch_ops->inject_gp(ctxt->vcpu, 0);
  1313. _eip = ctxt->vcpu->rip;
  1314. } else {
  1315. _regs[VCPU_REGS_RAX] = (u32)msr_data;
  1316. _regs[VCPU_REGS_RDX] = msr_data >> 32;
  1317. }
  1318. rc = X86EMUL_CONTINUE;
  1319. break;
  1320. case 0xc7: /* Grp9 (cmpxchg8b) */
  1321. {
  1322. u64 old, new;
  1323. if ((rc = ops->read_emulated(cr2, &old, 8, ctxt)) != 0)
  1324. goto done;
  1325. if (((u32) (old >> 0) != (u32) _regs[VCPU_REGS_RAX]) ||
  1326. ((u32) (old >> 32) != (u32) _regs[VCPU_REGS_RDX])) {
  1327. _regs[VCPU_REGS_RAX] = (u32) (old >> 0);
  1328. _regs[VCPU_REGS_RDX] = (u32) (old >> 32);
  1329. _eflags &= ~EFLG_ZF;
  1330. } else {
  1331. new = ((u64)_regs[VCPU_REGS_RCX] << 32)
  1332. | (u32) _regs[VCPU_REGS_RBX];
  1333. if ((rc = ops->cmpxchg_emulated(cr2, &old,
  1334. &new, 8, ctxt)) != 0)
  1335. goto done;
  1336. _eflags |= EFLG_ZF;
  1337. }
  1338. break;
  1339. }
  1340. }
  1341. goto writeback;
  1342. cannot_emulate:
  1343. DPRINTF("Cannot emulate %02x\n", b);
  1344. return -1;
  1345. }
  1346. #ifdef __XEN__
  1347. #include <asm/mm.h>
  1348. #include <asm/uaccess.h>
  1349. int
  1350. x86_emulate_read_std(unsigned long addr,
  1351. unsigned long *val,
  1352. unsigned int bytes, struct x86_emulate_ctxt *ctxt)
  1353. {
  1354. unsigned int rc;
  1355. *val = 0;
  1356. if ((rc = copy_from_user((void *)val, (void *)addr, bytes)) != 0) {
  1357. propagate_page_fault(addr + bytes - rc, 0); /* read fault */
  1358. return X86EMUL_PROPAGATE_FAULT;
  1359. }
  1360. return X86EMUL_CONTINUE;
  1361. }
  1362. int
  1363. x86_emulate_write_std(unsigned long addr,
  1364. unsigned long val,
  1365. unsigned int bytes, struct x86_emulate_ctxt *ctxt)
  1366. {
  1367. unsigned int rc;
  1368. if ((rc = copy_to_user((void *)addr, (void *)&val, bytes)) != 0) {
  1369. propagate_page_fault(addr + bytes - rc, PGERR_write_access);
  1370. return X86EMUL_PROPAGATE_FAULT;
  1371. }
  1372. return X86EMUL_CONTINUE;
  1373. }
  1374. #endif