x86_emulate.c 54 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040
  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 <linux/kvm_host.h>
  28. #include "kvm_cache_regs.h"
  29. #define DPRINTF(x...) do {} while (0)
  30. #endif
  31. #include <linux/module.h>
  32. #include <asm/kvm_x86_emulate.h>
  33. /*
  34. * Opcode effective-address decode tables.
  35. * Note that we only emulate instructions that have at least one memory
  36. * operand (excluding implicit stack references). We assume that stack
  37. * references and instruction fetches will never occur in special memory
  38. * areas that require emulation. So, for example, 'mov <imm>,<reg>' need
  39. * not be handled.
  40. */
  41. /* Operand sizes: 8-bit operands or specified/overridden size. */
  42. #define ByteOp (1<<0) /* 8-bit operands. */
  43. /* Destination operand type. */
  44. #define ImplicitOps (1<<1) /* Implicit in opcode. No generic decode. */
  45. #define DstReg (2<<1) /* Register operand. */
  46. #define DstMem (3<<1) /* Memory operand. */
  47. #define DstAcc (4<<1) /* Destination Accumulator */
  48. #define DstMask (7<<1)
  49. /* Source operand type. */
  50. #define SrcNone (0<<4) /* No source operand. */
  51. #define SrcImplicit (0<<4) /* Source operand is implicit in the opcode. */
  52. #define SrcReg (1<<4) /* Register operand. */
  53. #define SrcMem (2<<4) /* Memory operand. */
  54. #define SrcMem16 (3<<4) /* Memory operand (16-bit). */
  55. #define SrcMem32 (4<<4) /* Memory operand (32-bit). */
  56. #define SrcImm (5<<4) /* Immediate operand. */
  57. #define SrcImmByte (6<<4) /* 8-bit sign-extended immediate operand. */
  58. #define SrcMask (7<<4)
  59. /* Generic ModRM decode. */
  60. #define ModRM (1<<7)
  61. /* Destination is only written; never read. */
  62. #define Mov (1<<8)
  63. #define BitOp (1<<9)
  64. #define MemAbs (1<<10) /* Memory operand is absolute displacement */
  65. #define String (1<<12) /* String instruction (rep capable) */
  66. #define Stack (1<<13) /* Stack instruction (push/pop) */
  67. #define Group (1<<14) /* Bits 3:5 of modrm byte extend opcode */
  68. #define GroupDual (1<<15) /* Alternate decoding of mod == 3 */
  69. #define GroupMask 0xff /* Group number stored in bits 0:7 */
  70. enum {
  71. Group1_80, Group1_81, Group1_82, Group1_83,
  72. Group1A, Group3_Byte, Group3, Group4, Group5, Group7,
  73. };
  74. static u16 opcode_table[256] = {
  75. /* 0x00 - 0x07 */
  76. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  77. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  78. ByteOp | DstAcc | SrcImm, DstAcc | SrcImm, 0, 0,
  79. /* 0x08 - 0x0F */
  80. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  81. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  82. 0, 0, 0, 0,
  83. /* 0x10 - 0x17 */
  84. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  85. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  86. 0, 0, 0, 0,
  87. /* 0x18 - 0x1F */
  88. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  89. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  90. 0, 0, 0, 0,
  91. /* 0x20 - 0x27 */
  92. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  93. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  94. DstAcc | SrcImmByte, DstAcc | SrcImm, 0, 0,
  95. /* 0x28 - 0x2F */
  96. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  97. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  98. 0, 0, 0, 0,
  99. /* 0x30 - 0x37 */
  100. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  101. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  102. 0, 0, 0, 0,
  103. /* 0x38 - 0x3F */
  104. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  105. ByteOp | DstReg | SrcMem | ModRM, DstReg | SrcMem | ModRM,
  106. ByteOp | DstAcc | SrcImm, DstAcc | SrcImm,
  107. 0, 0,
  108. /* 0x40 - 0x47 */
  109. DstReg, DstReg, DstReg, DstReg, DstReg, DstReg, DstReg, DstReg,
  110. /* 0x48 - 0x4F */
  111. DstReg, DstReg, DstReg, DstReg, DstReg, DstReg, DstReg, DstReg,
  112. /* 0x50 - 0x57 */
  113. SrcReg | Stack, SrcReg | Stack, SrcReg | Stack, SrcReg | Stack,
  114. SrcReg | Stack, SrcReg | Stack, SrcReg | Stack, SrcReg | Stack,
  115. /* 0x58 - 0x5F */
  116. DstReg | Stack, DstReg | Stack, DstReg | Stack, DstReg | Stack,
  117. DstReg | Stack, DstReg | Stack, DstReg | Stack, DstReg | Stack,
  118. /* 0x60 - 0x67 */
  119. 0, 0, 0, DstReg | SrcMem32 | ModRM | Mov /* movsxd (x86/64) */ ,
  120. 0, 0, 0, 0,
  121. /* 0x68 - 0x6F */
  122. SrcImm | Mov | Stack, 0, SrcImmByte | Mov | Stack, 0,
  123. SrcNone | ByteOp | ImplicitOps, SrcNone | ImplicitOps, /* insb, insw/insd */
  124. SrcNone | ByteOp | ImplicitOps, SrcNone | ImplicitOps, /* outsb, outsw/outsd */
  125. /* 0x70 - 0x77 */
  126. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  127. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  128. /* 0x78 - 0x7F */
  129. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  130. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  131. /* 0x80 - 0x87 */
  132. Group | Group1_80, Group | Group1_81,
  133. Group | Group1_82, Group | Group1_83,
  134. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  135. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM,
  136. /* 0x88 - 0x8F */
  137. ByteOp | DstMem | SrcReg | ModRM | Mov, DstMem | SrcReg | ModRM | Mov,
  138. ByteOp | DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  139. DstMem | SrcReg | ModRM | Mov, ModRM | DstReg,
  140. DstReg | SrcMem | ModRM | Mov, Group | Group1A,
  141. /* 0x90 - 0x97 */
  142. DstReg, DstReg, DstReg, DstReg, DstReg, DstReg, DstReg, DstReg,
  143. /* 0x98 - 0x9F */
  144. 0, 0, 0, 0, ImplicitOps | Stack, ImplicitOps | Stack, 0, 0,
  145. /* 0xA0 - 0xA7 */
  146. ByteOp | DstReg | SrcMem | Mov | MemAbs, DstReg | SrcMem | Mov | MemAbs,
  147. ByteOp | DstMem | SrcReg | Mov | MemAbs, DstMem | SrcReg | Mov | MemAbs,
  148. ByteOp | ImplicitOps | Mov | String, ImplicitOps | Mov | String,
  149. ByteOp | ImplicitOps | String, ImplicitOps | String,
  150. /* 0xA8 - 0xAF */
  151. 0, 0, ByteOp | ImplicitOps | Mov | String, ImplicitOps | Mov | String,
  152. ByteOp | ImplicitOps | Mov | String, ImplicitOps | Mov | String,
  153. ByteOp | ImplicitOps | String, ImplicitOps | String,
  154. /* 0xB0 - 0xB7 */
  155. ByteOp | DstReg | SrcImm | Mov, ByteOp | DstReg | SrcImm | Mov,
  156. ByteOp | DstReg | SrcImm | Mov, ByteOp | DstReg | SrcImm | Mov,
  157. ByteOp | DstReg | SrcImm | Mov, ByteOp | DstReg | SrcImm | Mov,
  158. ByteOp | DstReg | SrcImm | Mov, ByteOp | DstReg | SrcImm | Mov,
  159. /* 0xB8 - 0xBF */
  160. DstReg | SrcImm | Mov, DstReg | SrcImm | Mov,
  161. DstReg | SrcImm | Mov, DstReg | SrcImm | Mov,
  162. DstReg | SrcImm | Mov, DstReg | SrcImm | Mov,
  163. DstReg | SrcImm | Mov, DstReg | SrcImm | Mov,
  164. /* 0xC0 - 0xC7 */
  165. ByteOp | DstMem | SrcImm | ModRM, DstMem | SrcImmByte | ModRM,
  166. 0, ImplicitOps | Stack, 0, 0,
  167. ByteOp | DstMem | SrcImm | ModRM | Mov, DstMem | SrcImm | ModRM | Mov,
  168. /* 0xC8 - 0xCF */
  169. 0, 0, 0, 0, 0, 0, 0, 0,
  170. /* 0xD0 - 0xD7 */
  171. ByteOp | DstMem | SrcImplicit | ModRM, DstMem | SrcImplicit | ModRM,
  172. ByteOp | DstMem | SrcImplicit | ModRM, DstMem | SrcImplicit | ModRM,
  173. 0, 0, 0, 0,
  174. /* 0xD8 - 0xDF */
  175. 0, 0, 0, 0, 0, 0, 0, 0,
  176. /* 0xE0 - 0xE7 */
  177. 0, 0, 0, 0,
  178. SrcNone | ByteOp | ImplicitOps, SrcNone | ImplicitOps,
  179. SrcNone | ByteOp | ImplicitOps, SrcNone | ImplicitOps,
  180. /* 0xE8 - 0xEF */
  181. ImplicitOps | Stack, SrcImm | ImplicitOps,
  182. ImplicitOps, SrcImmByte | ImplicitOps,
  183. SrcNone | ByteOp | ImplicitOps, SrcNone | ImplicitOps,
  184. SrcNone | ByteOp | ImplicitOps, SrcNone | ImplicitOps,
  185. /* 0xF0 - 0xF7 */
  186. 0, 0, 0, 0,
  187. ImplicitOps, ImplicitOps, Group | Group3_Byte, Group | Group3,
  188. /* 0xF8 - 0xFF */
  189. ImplicitOps, 0, ImplicitOps, ImplicitOps,
  190. ImplicitOps, ImplicitOps, Group | Group4, Group | Group5,
  191. };
  192. static u16 twobyte_table[256] = {
  193. /* 0x00 - 0x0F */
  194. 0, Group | GroupDual | Group7, 0, 0, 0, 0, ImplicitOps, 0,
  195. ImplicitOps, ImplicitOps, 0, 0, 0, ImplicitOps | ModRM, 0, 0,
  196. /* 0x10 - 0x1F */
  197. 0, 0, 0, 0, 0, 0, 0, 0, ImplicitOps | ModRM, 0, 0, 0, 0, 0, 0, 0,
  198. /* 0x20 - 0x2F */
  199. ModRM | ImplicitOps, ModRM, ModRM | ImplicitOps, ModRM, 0, 0, 0, 0,
  200. 0, 0, 0, 0, 0, 0, 0, 0,
  201. /* 0x30 - 0x3F */
  202. ImplicitOps, 0, ImplicitOps, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  203. /* 0x40 - 0x47 */
  204. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  205. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  206. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  207. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  208. /* 0x48 - 0x4F */
  209. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  210. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  211. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  212. DstReg | SrcMem | ModRM | Mov, DstReg | SrcMem | ModRM | Mov,
  213. /* 0x50 - 0x5F */
  214. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  215. /* 0x60 - 0x6F */
  216. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  217. /* 0x70 - 0x7F */
  218. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  219. /* 0x80 - 0x8F */
  220. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  221. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  222. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  223. ImplicitOps, ImplicitOps, ImplicitOps, ImplicitOps,
  224. /* 0x90 - 0x9F */
  225. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  226. /* 0xA0 - 0xA7 */
  227. 0, 0, 0, DstMem | SrcReg | ModRM | BitOp, 0, 0, 0, 0,
  228. /* 0xA8 - 0xAF */
  229. 0, 0, 0, DstMem | SrcReg | ModRM | BitOp, 0, 0, ModRM, 0,
  230. /* 0xB0 - 0xB7 */
  231. ByteOp | DstMem | SrcReg | ModRM, DstMem | SrcReg | ModRM, 0,
  232. DstMem | SrcReg | ModRM | BitOp,
  233. 0, 0, ByteOp | DstReg | SrcMem | ModRM | Mov,
  234. DstReg | SrcMem16 | ModRM | Mov,
  235. /* 0xB8 - 0xBF */
  236. 0, 0, DstMem | SrcImmByte | ModRM, DstMem | SrcReg | ModRM | BitOp,
  237. 0, 0, ByteOp | DstReg | SrcMem | ModRM | Mov,
  238. DstReg | SrcMem16 | ModRM | Mov,
  239. /* 0xC0 - 0xCF */
  240. 0, 0, 0, DstMem | SrcReg | ModRM | Mov, 0, 0, 0, ImplicitOps | ModRM,
  241. 0, 0, 0, 0, 0, 0, 0, 0,
  242. /* 0xD0 - 0xDF */
  243. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  244. /* 0xE0 - 0xEF */
  245. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  246. /* 0xF0 - 0xFF */
  247. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
  248. };
  249. static u16 group_table[] = {
  250. [Group1_80*8] =
  251. ByteOp | DstMem | SrcImm | ModRM, ByteOp | DstMem | SrcImm | ModRM,
  252. ByteOp | DstMem | SrcImm | ModRM, ByteOp | DstMem | SrcImm | ModRM,
  253. ByteOp | DstMem | SrcImm | ModRM, ByteOp | DstMem | SrcImm | ModRM,
  254. ByteOp | DstMem | SrcImm | ModRM, ByteOp | DstMem | SrcImm | ModRM,
  255. [Group1_81*8] =
  256. DstMem | SrcImm | ModRM, DstMem | SrcImm | ModRM,
  257. DstMem | SrcImm | ModRM, DstMem | SrcImm | ModRM,
  258. DstMem | SrcImm | ModRM, DstMem | SrcImm | ModRM,
  259. DstMem | SrcImm | ModRM, DstMem | SrcImm | ModRM,
  260. [Group1_82*8] =
  261. ByteOp | DstMem | SrcImm | ModRM, ByteOp | DstMem | SrcImm | ModRM,
  262. ByteOp | DstMem | SrcImm | ModRM, ByteOp | DstMem | SrcImm | ModRM,
  263. ByteOp | DstMem | SrcImm | ModRM, ByteOp | DstMem | SrcImm | ModRM,
  264. ByteOp | DstMem | SrcImm | ModRM, ByteOp | DstMem | SrcImm | ModRM,
  265. [Group1_83*8] =
  266. DstMem | SrcImmByte | ModRM, DstMem | SrcImmByte | ModRM,
  267. DstMem | SrcImmByte | ModRM, DstMem | SrcImmByte | ModRM,
  268. DstMem | SrcImmByte | ModRM, DstMem | SrcImmByte | ModRM,
  269. DstMem | SrcImmByte | ModRM, DstMem | SrcImmByte | ModRM,
  270. [Group1A*8] =
  271. DstMem | SrcNone | ModRM | Mov | Stack, 0, 0, 0, 0, 0, 0, 0,
  272. [Group3_Byte*8] =
  273. ByteOp | SrcImm | DstMem | ModRM, 0,
  274. ByteOp | DstMem | SrcNone | ModRM, ByteOp | DstMem | SrcNone | ModRM,
  275. 0, 0, 0, 0,
  276. [Group3*8] =
  277. DstMem | SrcImm | ModRM, 0,
  278. DstMem | SrcNone | ModRM, DstMem | SrcNone | ModRM,
  279. 0, 0, 0, 0,
  280. [Group4*8] =
  281. ByteOp | DstMem | SrcNone | ModRM, ByteOp | DstMem | SrcNone | ModRM,
  282. 0, 0, 0, 0, 0, 0,
  283. [Group5*8] =
  284. DstMem | SrcNone | ModRM, DstMem | SrcNone | ModRM,
  285. SrcMem | ModRM | Stack, 0,
  286. SrcMem | ModRM | Stack, 0, SrcMem | ModRM | Stack, 0,
  287. [Group7*8] =
  288. 0, 0, ModRM | SrcMem, ModRM | SrcMem,
  289. SrcNone | ModRM | DstMem | Mov, 0,
  290. SrcMem16 | ModRM | Mov, SrcMem | ModRM | ByteOp,
  291. };
  292. static u16 group2_table[] = {
  293. [Group7*8] =
  294. SrcNone | ModRM, 0, 0, 0,
  295. SrcNone | ModRM | DstMem | Mov, 0,
  296. SrcMem16 | ModRM | Mov, 0,
  297. };
  298. /* EFLAGS bit definitions. */
  299. #define EFLG_OF (1<<11)
  300. #define EFLG_DF (1<<10)
  301. #define EFLG_SF (1<<7)
  302. #define EFLG_ZF (1<<6)
  303. #define EFLG_AF (1<<4)
  304. #define EFLG_PF (1<<2)
  305. #define EFLG_CF (1<<0)
  306. /*
  307. * Instruction emulation:
  308. * Most instructions are emulated directly via a fragment of inline assembly
  309. * code. This allows us to save/restore EFLAGS and thus very easily pick up
  310. * any modified flags.
  311. */
  312. #if defined(CONFIG_X86_64)
  313. #define _LO32 "k" /* force 32-bit operand */
  314. #define _STK "%%rsp" /* stack pointer */
  315. #elif defined(__i386__)
  316. #define _LO32 "" /* force 32-bit operand */
  317. #define _STK "%%esp" /* stack pointer */
  318. #endif
  319. /*
  320. * These EFLAGS bits are restored from saved value during emulation, and
  321. * any changes are written back to the saved value after emulation.
  322. */
  323. #define EFLAGS_MASK (EFLG_OF|EFLG_SF|EFLG_ZF|EFLG_AF|EFLG_PF|EFLG_CF)
  324. /* Before executing instruction: restore necessary bits in EFLAGS. */
  325. #define _PRE_EFLAGS(_sav, _msk, _tmp) \
  326. /* EFLAGS = (_sav & _msk) | (EFLAGS & ~_msk); _sav &= ~_msk; */ \
  327. "movl %"_sav",%"_LO32 _tmp"; " \
  328. "push %"_tmp"; " \
  329. "push %"_tmp"; " \
  330. "movl %"_msk",%"_LO32 _tmp"; " \
  331. "andl %"_LO32 _tmp",("_STK"); " \
  332. "pushf; " \
  333. "notl %"_LO32 _tmp"; " \
  334. "andl %"_LO32 _tmp",("_STK"); " \
  335. "andl %"_LO32 _tmp","__stringify(BITS_PER_LONG/4)"("_STK"); " \
  336. "pop %"_tmp"; " \
  337. "orl %"_LO32 _tmp",("_STK"); " \
  338. "popf; " \
  339. "pop %"_sav"; "
  340. /* After executing instruction: write-back necessary bits in EFLAGS. */
  341. #define _POST_EFLAGS(_sav, _msk, _tmp) \
  342. /* _sav |= EFLAGS & _msk; */ \
  343. "pushf; " \
  344. "pop %"_tmp"; " \
  345. "andl %"_msk",%"_LO32 _tmp"; " \
  346. "orl %"_LO32 _tmp",%"_sav"; "
  347. #ifdef CONFIG_X86_64
  348. #define ON64(x) x
  349. #else
  350. #define ON64(x)
  351. #endif
  352. #define ____emulate_2op(_op, _src, _dst, _eflags, _x, _y, _suffix) \
  353. do { \
  354. __asm__ __volatile__ ( \
  355. _PRE_EFLAGS("0", "4", "2") \
  356. _op _suffix " %"_x"3,%1; " \
  357. _POST_EFLAGS("0", "4", "2") \
  358. : "=m" (_eflags), "=m" ((_dst).val), \
  359. "=&r" (_tmp) \
  360. : _y ((_src).val), "i" (EFLAGS_MASK)); \
  361. } while (0);
  362. /* Raw emulation: instruction has two explicit operands. */
  363. #define __emulate_2op_nobyte(_op,_src,_dst,_eflags,_wx,_wy,_lx,_ly,_qx,_qy) \
  364. do { \
  365. unsigned long _tmp; \
  366. \
  367. switch ((_dst).bytes) { \
  368. case 2: \
  369. ____emulate_2op(_op,_src,_dst,_eflags,_wx,_wy,"w"); \
  370. break; \
  371. case 4: \
  372. ____emulate_2op(_op,_src,_dst,_eflags,_lx,_ly,"l"); \
  373. break; \
  374. case 8: \
  375. ON64(____emulate_2op(_op,_src,_dst,_eflags,_qx,_qy,"q")); \
  376. break; \
  377. } \
  378. } while (0)
  379. #define __emulate_2op(_op,_src,_dst,_eflags,_bx,_by,_wx,_wy,_lx,_ly,_qx,_qy) \
  380. do { \
  381. unsigned long _tmp; \
  382. switch ((_dst).bytes) { \
  383. case 1: \
  384. ____emulate_2op(_op,_src,_dst,_eflags,_bx,_by,"b"); \
  385. break; \
  386. default: \
  387. __emulate_2op_nobyte(_op, _src, _dst, _eflags, \
  388. _wx, _wy, _lx, _ly, _qx, _qy); \
  389. break; \
  390. } \
  391. } while (0)
  392. /* Source operand is byte-sized and may be restricted to just %cl. */
  393. #define emulate_2op_SrcB(_op, _src, _dst, _eflags) \
  394. __emulate_2op(_op, _src, _dst, _eflags, \
  395. "b", "c", "b", "c", "b", "c", "b", "c")
  396. /* Source operand is byte, word, long or quad sized. */
  397. #define emulate_2op_SrcV(_op, _src, _dst, _eflags) \
  398. __emulate_2op(_op, _src, _dst, _eflags, \
  399. "b", "q", "w", "r", _LO32, "r", "", "r")
  400. /* Source operand is word, long or quad sized. */
  401. #define emulate_2op_SrcV_nobyte(_op, _src, _dst, _eflags) \
  402. __emulate_2op_nobyte(_op, _src, _dst, _eflags, \
  403. "w", "r", _LO32, "r", "", "r")
  404. #define __emulate_1op(_op, _dst, _eflags, _suffix) \
  405. do { \
  406. unsigned long _tmp; \
  407. \
  408. __asm__ __volatile__ ( \
  409. _PRE_EFLAGS("0", "3", "2") \
  410. _op _suffix " %1; " \
  411. _POST_EFLAGS("0", "3", "2") \
  412. : "=m" (_eflags), "+m" ((_dst).val), \
  413. "=&r" (_tmp) \
  414. : "i" (EFLAGS_MASK)); \
  415. } while (0)
  416. /* Instruction has only one explicit operand (no source operand). */
  417. #define emulate_1op(_op, _dst, _eflags) \
  418. do { \
  419. switch ((_dst).bytes) { \
  420. case 1: __emulate_1op(_op, _dst, _eflags, "b"); break; \
  421. case 2: __emulate_1op(_op, _dst, _eflags, "w"); break; \
  422. case 4: __emulate_1op(_op, _dst, _eflags, "l"); break; \
  423. case 8: ON64(__emulate_1op(_op, _dst, _eflags, "q")); break; \
  424. } \
  425. } while (0)
  426. /* Fetch next part of the instruction being emulated. */
  427. #define insn_fetch(_type, _size, _eip) \
  428. ({ unsigned long _x; \
  429. rc = do_insn_fetch(ctxt, ops, (_eip), &_x, (_size)); \
  430. if (rc != 0) \
  431. goto done; \
  432. (_eip) += (_size); \
  433. (_type)_x; \
  434. })
  435. static inline unsigned long ad_mask(struct decode_cache *c)
  436. {
  437. return (1UL << (c->ad_bytes << 3)) - 1;
  438. }
  439. /* Access/update address held in a register, based on addressing mode. */
  440. static inline unsigned long
  441. address_mask(struct decode_cache *c, unsigned long reg)
  442. {
  443. if (c->ad_bytes == sizeof(unsigned long))
  444. return reg;
  445. else
  446. return reg & ad_mask(c);
  447. }
  448. static inline unsigned long
  449. register_address(struct decode_cache *c, unsigned long base, unsigned long reg)
  450. {
  451. return base + address_mask(c, reg);
  452. }
  453. static inline void
  454. register_address_increment(struct decode_cache *c, unsigned long *reg, int inc)
  455. {
  456. if (c->ad_bytes == sizeof(unsigned long))
  457. *reg += inc;
  458. else
  459. *reg = (*reg & ~ad_mask(c)) | ((*reg + inc) & ad_mask(c));
  460. }
  461. static inline void jmp_rel(struct decode_cache *c, int rel)
  462. {
  463. register_address_increment(c, &c->eip, rel);
  464. }
  465. static void set_seg_override(struct decode_cache *c, int seg)
  466. {
  467. c->has_seg_override = true;
  468. c->seg_override = seg;
  469. }
  470. static unsigned long seg_base(struct x86_emulate_ctxt *ctxt, int seg)
  471. {
  472. if (ctxt->mode == X86EMUL_MODE_PROT64 && seg < VCPU_SREG_FS)
  473. return 0;
  474. return kvm_x86_ops->get_segment_base(ctxt->vcpu, seg);
  475. }
  476. static unsigned long seg_override_base(struct x86_emulate_ctxt *ctxt,
  477. struct decode_cache *c)
  478. {
  479. if (!c->has_seg_override)
  480. return 0;
  481. return seg_base(ctxt, c->seg_override);
  482. }
  483. static unsigned long es_base(struct x86_emulate_ctxt *ctxt)
  484. {
  485. return seg_base(ctxt, VCPU_SREG_ES);
  486. }
  487. static unsigned long ss_base(struct x86_emulate_ctxt *ctxt)
  488. {
  489. return seg_base(ctxt, VCPU_SREG_SS);
  490. }
  491. static int do_fetch_insn_byte(struct x86_emulate_ctxt *ctxt,
  492. struct x86_emulate_ops *ops,
  493. unsigned long linear, u8 *dest)
  494. {
  495. struct fetch_cache *fc = &ctxt->decode.fetch;
  496. int rc;
  497. int size;
  498. if (linear < fc->start || linear >= fc->end) {
  499. size = min(15UL, PAGE_SIZE - offset_in_page(linear));
  500. rc = ops->read_std(linear, fc->data, size, ctxt->vcpu);
  501. if (rc)
  502. return rc;
  503. fc->start = linear;
  504. fc->end = linear + size;
  505. }
  506. *dest = fc->data[linear - fc->start];
  507. return 0;
  508. }
  509. static int do_insn_fetch(struct x86_emulate_ctxt *ctxt,
  510. struct x86_emulate_ops *ops,
  511. unsigned long eip, void *dest, unsigned size)
  512. {
  513. int rc = 0;
  514. eip += ctxt->cs_base;
  515. while (size--) {
  516. rc = do_fetch_insn_byte(ctxt, ops, eip++, dest++);
  517. if (rc)
  518. return rc;
  519. }
  520. return 0;
  521. }
  522. /*
  523. * Given the 'reg' portion of a ModRM byte, and a register block, return a
  524. * pointer into the block that addresses the relevant register.
  525. * @highbyte_regs specifies whether to decode AH,CH,DH,BH.
  526. */
  527. static void *decode_register(u8 modrm_reg, unsigned long *regs,
  528. int highbyte_regs)
  529. {
  530. void *p;
  531. p = &regs[modrm_reg];
  532. if (highbyte_regs && modrm_reg >= 4 && modrm_reg < 8)
  533. p = (unsigned char *)&regs[modrm_reg & 3] + 1;
  534. return p;
  535. }
  536. static int read_descriptor(struct x86_emulate_ctxt *ctxt,
  537. struct x86_emulate_ops *ops,
  538. void *ptr,
  539. u16 *size, unsigned long *address, int op_bytes)
  540. {
  541. int rc;
  542. if (op_bytes == 2)
  543. op_bytes = 3;
  544. *address = 0;
  545. rc = ops->read_std((unsigned long)ptr, (unsigned long *)size, 2,
  546. ctxt->vcpu);
  547. if (rc)
  548. return rc;
  549. rc = ops->read_std((unsigned long)ptr + 2, address, op_bytes,
  550. ctxt->vcpu);
  551. return rc;
  552. }
  553. static int test_cc(unsigned int condition, unsigned int flags)
  554. {
  555. int rc = 0;
  556. switch ((condition & 15) >> 1) {
  557. case 0: /* o */
  558. rc |= (flags & EFLG_OF);
  559. break;
  560. case 1: /* b/c/nae */
  561. rc |= (flags & EFLG_CF);
  562. break;
  563. case 2: /* z/e */
  564. rc |= (flags & EFLG_ZF);
  565. break;
  566. case 3: /* be/na */
  567. rc |= (flags & (EFLG_CF|EFLG_ZF));
  568. break;
  569. case 4: /* s */
  570. rc |= (flags & EFLG_SF);
  571. break;
  572. case 5: /* p/pe */
  573. rc |= (flags & EFLG_PF);
  574. break;
  575. case 7: /* le/ng */
  576. rc |= (flags & EFLG_ZF);
  577. /* fall through */
  578. case 6: /* l/nge */
  579. rc |= (!(flags & EFLG_SF) != !(flags & EFLG_OF));
  580. break;
  581. }
  582. /* Odd condition identifiers (lsb == 1) have inverted sense. */
  583. return (!!rc ^ (condition & 1));
  584. }
  585. static void decode_register_operand(struct operand *op,
  586. struct decode_cache *c,
  587. int inhibit_bytereg)
  588. {
  589. unsigned reg = c->modrm_reg;
  590. int highbyte_regs = c->rex_prefix == 0;
  591. if (!(c->d & ModRM))
  592. reg = (c->b & 7) | ((c->rex_prefix & 1) << 3);
  593. op->type = OP_REG;
  594. if ((c->d & ByteOp) && !inhibit_bytereg) {
  595. op->ptr = decode_register(reg, c->regs, highbyte_regs);
  596. op->val = *(u8 *)op->ptr;
  597. op->bytes = 1;
  598. } else {
  599. op->ptr = decode_register(reg, c->regs, 0);
  600. op->bytes = c->op_bytes;
  601. switch (op->bytes) {
  602. case 2:
  603. op->val = *(u16 *)op->ptr;
  604. break;
  605. case 4:
  606. op->val = *(u32 *)op->ptr;
  607. break;
  608. case 8:
  609. op->val = *(u64 *) op->ptr;
  610. break;
  611. }
  612. }
  613. op->orig_val = op->val;
  614. }
  615. static int decode_modrm(struct x86_emulate_ctxt *ctxt,
  616. struct x86_emulate_ops *ops)
  617. {
  618. struct decode_cache *c = &ctxt->decode;
  619. u8 sib;
  620. int index_reg = 0, base_reg = 0, scale;
  621. int rc = 0;
  622. if (c->rex_prefix) {
  623. c->modrm_reg = (c->rex_prefix & 4) << 1; /* REX.R */
  624. index_reg = (c->rex_prefix & 2) << 2; /* REX.X */
  625. c->modrm_rm = base_reg = (c->rex_prefix & 1) << 3; /* REG.B */
  626. }
  627. c->modrm = insn_fetch(u8, 1, c->eip);
  628. c->modrm_mod |= (c->modrm & 0xc0) >> 6;
  629. c->modrm_reg |= (c->modrm & 0x38) >> 3;
  630. c->modrm_rm |= (c->modrm & 0x07);
  631. c->modrm_ea = 0;
  632. c->use_modrm_ea = 1;
  633. if (c->modrm_mod == 3) {
  634. c->modrm_ptr = decode_register(c->modrm_rm,
  635. c->regs, c->d & ByteOp);
  636. c->modrm_val = *(unsigned long *)c->modrm_ptr;
  637. return rc;
  638. }
  639. if (c->ad_bytes == 2) {
  640. unsigned bx = c->regs[VCPU_REGS_RBX];
  641. unsigned bp = c->regs[VCPU_REGS_RBP];
  642. unsigned si = c->regs[VCPU_REGS_RSI];
  643. unsigned di = c->regs[VCPU_REGS_RDI];
  644. /* 16-bit ModR/M decode. */
  645. switch (c->modrm_mod) {
  646. case 0:
  647. if (c->modrm_rm == 6)
  648. c->modrm_ea += insn_fetch(u16, 2, c->eip);
  649. break;
  650. case 1:
  651. c->modrm_ea += insn_fetch(s8, 1, c->eip);
  652. break;
  653. case 2:
  654. c->modrm_ea += insn_fetch(u16, 2, c->eip);
  655. break;
  656. }
  657. switch (c->modrm_rm) {
  658. case 0:
  659. c->modrm_ea += bx + si;
  660. break;
  661. case 1:
  662. c->modrm_ea += bx + di;
  663. break;
  664. case 2:
  665. c->modrm_ea += bp + si;
  666. break;
  667. case 3:
  668. c->modrm_ea += bp + di;
  669. break;
  670. case 4:
  671. c->modrm_ea += si;
  672. break;
  673. case 5:
  674. c->modrm_ea += di;
  675. break;
  676. case 6:
  677. if (c->modrm_mod != 0)
  678. c->modrm_ea += bp;
  679. break;
  680. case 7:
  681. c->modrm_ea += bx;
  682. break;
  683. }
  684. if (c->modrm_rm == 2 || c->modrm_rm == 3 ||
  685. (c->modrm_rm == 6 && c->modrm_mod != 0))
  686. if (!c->has_seg_override)
  687. set_seg_override(c, VCPU_SREG_SS);
  688. c->modrm_ea = (u16)c->modrm_ea;
  689. } else {
  690. /* 32/64-bit ModR/M decode. */
  691. if ((c->modrm_rm & 7) == 4) {
  692. sib = insn_fetch(u8, 1, c->eip);
  693. index_reg |= (sib >> 3) & 7;
  694. base_reg |= sib & 7;
  695. scale = sib >> 6;
  696. if ((base_reg & 7) == 5 && c->modrm_mod == 0)
  697. c->modrm_ea += insn_fetch(s32, 4, c->eip);
  698. else
  699. c->modrm_ea += c->regs[base_reg];
  700. if (index_reg != 4)
  701. c->modrm_ea += c->regs[index_reg] << scale;
  702. } else if ((c->modrm_rm & 7) == 5 && c->modrm_mod == 0) {
  703. if (ctxt->mode == X86EMUL_MODE_PROT64)
  704. c->rip_relative = 1;
  705. } else
  706. c->modrm_ea += c->regs[c->modrm_rm];
  707. switch (c->modrm_mod) {
  708. case 0:
  709. if (c->modrm_rm == 5)
  710. c->modrm_ea += insn_fetch(s32, 4, c->eip);
  711. break;
  712. case 1:
  713. c->modrm_ea += insn_fetch(s8, 1, c->eip);
  714. break;
  715. case 2:
  716. c->modrm_ea += insn_fetch(s32, 4, c->eip);
  717. break;
  718. }
  719. }
  720. done:
  721. return rc;
  722. }
  723. static int decode_abs(struct x86_emulate_ctxt *ctxt,
  724. struct x86_emulate_ops *ops)
  725. {
  726. struct decode_cache *c = &ctxt->decode;
  727. int rc = 0;
  728. switch (c->ad_bytes) {
  729. case 2:
  730. c->modrm_ea = insn_fetch(u16, 2, c->eip);
  731. break;
  732. case 4:
  733. c->modrm_ea = insn_fetch(u32, 4, c->eip);
  734. break;
  735. case 8:
  736. c->modrm_ea = insn_fetch(u64, 8, c->eip);
  737. break;
  738. }
  739. done:
  740. return rc;
  741. }
  742. int
  743. x86_decode_insn(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops)
  744. {
  745. struct decode_cache *c = &ctxt->decode;
  746. int rc = 0;
  747. int mode = ctxt->mode;
  748. int def_op_bytes, def_ad_bytes, group;
  749. /* Shadow copy of register state. Committed on successful emulation. */
  750. memset(c, 0, sizeof(struct decode_cache));
  751. c->eip = kvm_rip_read(ctxt->vcpu);
  752. ctxt->cs_base = seg_base(ctxt, VCPU_SREG_CS);
  753. memcpy(c->regs, ctxt->vcpu->arch.regs, sizeof c->regs);
  754. switch (mode) {
  755. case X86EMUL_MODE_REAL:
  756. case X86EMUL_MODE_PROT16:
  757. def_op_bytes = def_ad_bytes = 2;
  758. break;
  759. case X86EMUL_MODE_PROT32:
  760. def_op_bytes = def_ad_bytes = 4;
  761. break;
  762. #ifdef CONFIG_X86_64
  763. case X86EMUL_MODE_PROT64:
  764. def_op_bytes = 4;
  765. def_ad_bytes = 8;
  766. break;
  767. #endif
  768. default:
  769. return -1;
  770. }
  771. c->op_bytes = def_op_bytes;
  772. c->ad_bytes = def_ad_bytes;
  773. /* Legacy prefixes. */
  774. for (;;) {
  775. switch (c->b = insn_fetch(u8, 1, c->eip)) {
  776. case 0x66: /* operand-size override */
  777. /* switch between 2/4 bytes */
  778. c->op_bytes = def_op_bytes ^ 6;
  779. break;
  780. case 0x67: /* address-size override */
  781. if (mode == X86EMUL_MODE_PROT64)
  782. /* switch between 4/8 bytes */
  783. c->ad_bytes = def_ad_bytes ^ 12;
  784. else
  785. /* switch between 2/4 bytes */
  786. c->ad_bytes = def_ad_bytes ^ 6;
  787. break;
  788. case 0x26: /* ES override */
  789. case 0x2e: /* CS override */
  790. case 0x36: /* SS override */
  791. case 0x3e: /* DS override */
  792. set_seg_override(c, (c->b >> 3) & 3);
  793. break;
  794. case 0x64: /* FS override */
  795. case 0x65: /* GS override */
  796. set_seg_override(c, c->b & 7);
  797. break;
  798. case 0x40 ... 0x4f: /* REX */
  799. if (mode != X86EMUL_MODE_PROT64)
  800. goto done_prefixes;
  801. c->rex_prefix = c->b;
  802. continue;
  803. case 0xf0: /* LOCK */
  804. c->lock_prefix = 1;
  805. break;
  806. case 0xf2: /* REPNE/REPNZ */
  807. c->rep_prefix = REPNE_PREFIX;
  808. break;
  809. case 0xf3: /* REP/REPE/REPZ */
  810. c->rep_prefix = REPE_PREFIX;
  811. break;
  812. default:
  813. goto done_prefixes;
  814. }
  815. /* Any legacy prefix after a REX prefix nullifies its effect. */
  816. c->rex_prefix = 0;
  817. }
  818. done_prefixes:
  819. /* REX prefix. */
  820. if (c->rex_prefix)
  821. if (c->rex_prefix & 8)
  822. c->op_bytes = 8; /* REX.W */
  823. /* Opcode byte(s). */
  824. c->d = opcode_table[c->b];
  825. if (c->d == 0) {
  826. /* Two-byte opcode? */
  827. if (c->b == 0x0f) {
  828. c->twobyte = 1;
  829. c->b = insn_fetch(u8, 1, c->eip);
  830. c->d = twobyte_table[c->b];
  831. }
  832. }
  833. if (c->d & Group) {
  834. group = c->d & GroupMask;
  835. c->modrm = insn_fetch(u8, 1, c->eip);
  836. --c->eip;
  837. group = (group << 3) + ((c->modrm >> 3) & 7);
  838. if ((c->d & GroupDual) && (c->modrm >> 6) == 3)
  839. c->d = group2_table[group];
  840. else
  841. c->d = group_table[group];
  842. }
  843. /* Unrecognised? */
  844. if (c->d == 0) {
  845. DPRINTF("Cannot emulate %02x\n", c->b);
  846. return -1;
  847. }
  848. if (mode == X86EMUL_MODE_PROT64 && (c->d & Stack))
  849. c->op_bytes = 8;
  850. /* ModRM and SIB bytes. */
  851. if (c->d & ModRM)
  852. rc = decode_modrm(ctxt, ops);
  853. else if (c->d & MemAbs)
  854. rc = decode_abs(ctxt, ops);
  855. if (rc)
  856. goto done;
  857. if (!c->has_seg_override)
  858. set_seg_override(c, VCPU_SREG_DS);
  859. if (!(!c->twobyte && c->b == 0x8d))
  860. c->modrm_ea += seg_override_base(ctxt, c);
  861. if (c->ad_bytes != 8)
  862. c->modrm_ea = (u32)c->modrm_ea;
  863. /*
  864. * Decode and fetch the source operand: register, memory
  865. * or immediate.
  866. */
  867. switch (c->d & SrcMask) {
  868. case SrcNone:
  869. break;
  870. case SrcReg:
  871. decode_register_operand(&c->src, c, 0);
  872. break;
  873. case SrcMem16:
  874. c->src.bytes = 2;
  875. goto srcmem_common;
  876. case SrcMem32:
  877. c->src.bytes = 4;
  878. goto srcmem_common;
  879. case SrcMem:
  880. c->src.bytes = (c->d & ByteOp) ? 1 :
  881. c->op_bytes;
  882. /* Don't fetch the address for invlpg: it could be unmapped. */
  883. if (c->twobyte && c->b == 0x01 && c->modrm_reg == 7)
  884. break;
  885. srcmem_common:
  886. /*
  887. * For instructions with a ModR/M byte, switch to register
  888. * access if Mod = 3.
  889. */
  890. if ((c->d & ModRM) && c->modrm_mod == 3) {
  891. c->src.type = OP_REG;
  892. c->src.val = c->modrm_val;
  893. c->src.ptr = c->modrm_ptr;
  894. break;
  895. }
  896. c->src.type = OP_MEM;
  897. break;
  898. case SrcImm:
  899. c->src.type = OP_IMM;
  900. c->src.ptr = (unsigned long *)c->eip;
  901. c->src.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
  902. if (c->src.bytes == 8)
  903. c->src.bytes = 4;
  904. /* NB. Immediates are sign-extended as necessary. */
  905. switch (c->src.bytes) {
  906. case 1:
  907. c->src.val = insn_fetch(s8, 1, c->eip);
  908. break;
  909. case 2:
  910. c->src.val = insn_fetch(s16, 2, c->eip);
  911. break;
  912. case 4:
  913. c->src.val = insn_fetch(s32, 4, c->eip);
  914. break;
  915. }
  916. break;
  917. case SrcImmByte:
  918. c->src.type = OP_IMM;
  919. c->src.ptr = (unsigned long *)c->eip;
  920. c->src.bytes = 1;
  921. c->src.val = insn_fetch(s8, 1, c->eip);
  922. break;
  923. }
  924. /* Decode and fetch the destination operand: register or memory. */
  925. switch (c->d & DstMask) {
  926. case ImplicitOps:
  927. /* Special instructions do their own operand decoding. */
  928. return 0;
  929. case DstReg:
  930. decode_register_operand(&c->dst, c,
  931. c->twobyte && (c->b == 0xb6 || c->b == 0xb7));
  932. break;
  933. case DstMem:
  934. if ((c->d & ModRM) && c->modrm_mod == 3) {
  935. c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
  936. c->dst.type = OP_REG;
  937. c->dst.val = c->dst.orig_val = c->modrm_val;
  938. c->dst.ptr = c->modrm_ptr;
  939. break;
  940. }
  941. c->dst.type = OP_MEM;
  942. break;
  943. case DstAcc:
  944. c->dst.type = OP_REG;
  945. c->dst.bytes = c->op_bytes;
  946. c->dst.ptr = &c->regs[VCPU_REGS_RAX];
  947. switch (c->op_bytes) {
  948. case 1:
  949. c->dst.val = *(u8 *)c->dst.ptr;
  950. break;
  951. case 2:
  952. c->dst.val = *(u16 *)c->dst.ptr;
  953. break;
  954. case 4:
  955. c->dst.val = *(u32 *)c->dst.ptr;
  956. break;
  957. }
  958. c->dst.orig_val = c->dst.val;
  959. break;
  960. }
  961. if (c->rip_relative)
  962. c->modrm_ea += c->eip;
  963. done:
  964. return (rc == X86EMUL_UNHANDLEABLE) ? -1 : 0;
  965. }
  966. static inline void emulate_push(struct x86_emulate_ctxt *ctxt)
  967. {
  968. struct decode_cache *c = &ctxt->decode;
  969. c->dst.type = OP_MEM;
  970. c->dst.bytes = c->op_bytes;
  971. c->dst.val = c->src.val;
  972. register_address_increment(c, &c->regs[VCPU_REGS_RSP], -c->op_bytes);
  973. c->dst.ptr = (void *) register_address(c, ss_base(ctxt),
  974. c->regs[VCPU_REGS_RSP]);
  975. }
  976. static int emulate_pop(struct x86_emulate_ctxt *ctxt,
  977. struct x86_emulate_ops *ops)
  978. {
  979. struct decode_cache *c = &ctxt->decode;
  980. int rc;
  981. rc = ops->read_emulated(register_address(c, ss_base(ctxt),
  982. c->regs[VCPU_REGS_RSP]),
  983. &c->src.val, c->src.bytes, ctxt->vcpu);
  984. if (rc != 0)
  985. return rc;
  986. register_address_increment(c, &c->regs[VCPU_REGS_RSP], c->src.bytes);
  987. return rc;
  988. }
  989. static inline int emulate_grp1a(struct x86_emulate_ctxt *ctxt,
  990. struct x86_emulate_ops *ops)
  991. {
  992. struct decode_cache *c = &ctxt->decode;
  993. int rc;
  994. c->src.bytes = c->dst.bytes;
  995. rc = emulate_pop(ctxt, ops);
  996. if (rc != 0)
  997. return rc;
  998. c->dst.val = c->src.val;
  999. return 0;
  1000. }
  1001. static inline void emulate_grp2(struct x86_emulate_ctxt *ctxt)
  1002. {
  1003. struct decode_cache *c = &ctxt->decode;
  1004. switch (c->modrm_reg) {
  1005. case 0: /* rol */
  1006. emulate_2op_SrcB("rol", c->src, c->dst, ctxt->eflags);
  1007. break;
  1008. case 1: /* ror */
  1009. emulate_2op_SrcB("ror", c->src, c->dst, ctxt->eflags);
  1010. break;
  1011. case 2: /* rcl */
  1012. emulate_2op_SrcB("rcl", c->src, c->dst, ctxt->eflags);
  1013. break;
  1014. case 3: /* rcr */
  1015. emulate_2op_SrcB("rcr", c->src, c->dst, ctxt->eflags);
  1016. break;
  1017. case 4: /* sal/shl */
  1018. case 6: /* sal/shl */
  1019. emulate_2op_SrcB("sal", c->src, c->dst, ctxt->eflags);
  1020. break;
  1021. case 5: /* shr */
  1022. emulate_2op_SrcB("shr", c->src, c->dst, ctxt->eflags);
  1023. break;
  1024. case 7: /* sar */
  1025. emulate_2op_SrcB("sar", c->src, c->dst, ctxt->eflags);
  1026. break;
  1027. }
  1028. }
  1029. static inline int emulate_grp3(struct x86_emulate_ctxt *ctxt,
  1030. struct x86_emulate_ops *ops)
  1031. {
  1032. struct decode_cache *c = &ctxt->decode;
  1033. int rc = 0;
  1034. switch (c->modrm_reg) {
  1035. case 0 ... 1: /* test */
  1036. emulate_2op_SrcV("test", c->src, c->dst, ctxt->eflags);
  1037. break;
  1038. case 2: /* not */
  1039. c->dst.val = ~c->dst.val;
  1040. break;
  1041. case 3: /* neg */
  1042. emulate_1op("neg", c->dst, ctxt->eflags);
  1043. break;
  1044. default:
  1045. DPRINTF("Cannot emulate %02x\n", c->b);
  1046. rc = X86EMUL_UNHANDLEABLE;
  1047. break;
  1048. }
  1049. return rc;
  1050. }
  1051. static inline int emulate_grp45(struct x86_emulate_ctxt *ctxt,
  1052. struct x86_emulate_ops *ops)
  1053. {
  1054. struct decode_cache *c = &ctxt->decode;
  1055. switch (c->modrm_reg) {
  1056. case 0: /* inc */
  1057. emulate_1op("inc", c->dst, ctxt->eflags);
  1058. break;
  1059. case 1: /* dec */
  1060. emulate_1op("dec", c->dst, ctxt->eflags);
  1061. break;
  1062. case 2: /* call near abs */ {
  1063. long int old_eip;
  1064. old_eip = c->eip;
  1065. c->eip = c->src.val;
  1066. c->src.val = old_eip;
  1067. emulate_push(ctxt);
  1068. break;
  1069. }
  1070. case 4: /* jmp abs */
  1071. c->eip = c->src.val;
  1072. break;
  1073. case 6: /* push */
  1074. emulate_push(ctxt);
  1075. break;
  1076. }
  1077. return 0;
  1078. }
  1079. static inline int emulate_grp9(struct x86_emulate_ctxt *ctxt,
  1080. struct x86_emulate_ops *ops,
  1081. unsigned long memop)
  1082. {
  1083. struct decode_cache *c = &ctxt->decode;
  1084. u64 old, new;
  1085. int rc;
  1086. rc = ops->read_emulated(memop, &old, 8, ctxt->vcpu);
  1087. if (rc != 0)
  1088. return rc;
  1089. if (((u32) (old >> 0) != (u32) c->regs[VCPU_REGS_RAX]) ||
  1090. ((u32) (old >> 32) != (u32) c->regs[VCPU_REGS_RDX])) {
  1091. c->regs[VCPU_REGS_RAX] = (u32) (old >> 0);
  1092. c->regs[VCPU_REGS_RDX] = (u32) (old >> 32);
  1093. ctxt->eflags &= ~EFLG_ZF;
  1094. } else {
  1095. new = ((u64)c->regs[VCPU_REGS_RCX] << 32) |
  1096. (u32) c->regs[VCPU_REGS_RBX];
  1097. rc = ops->cmpxchg_emulated(memop, &old, &new, 8, ctxt->vcpu);
  1098. if (rc != 0)
  1099. return rc;
  1100. ctxt->eflags |= EFLG_ZF;
  1101. }
  1102. return 0;
  1103. }
  1104. static inline int writeback(struct x86_emulate_ctxt *ctxt,
  1105. struct x86_emulate_ops *ops)
  1106. {
  1107. int rc;
  1108. struct decode_cache *c = &ctxt->decode;
  1109. switch (c->dst.type) {
  1110. case OP_REG:
  1111. /* The 4-byte case *is* correct:
  1112. * in 64-bit mode we zero-extend.
  1113. */
  1114. switch (c->dst.bytes) {
  1115. case 1:
  1116. *(u8 *)c->dst.ptr = (u8)c->dst.val;
  1117. break;
  1118. case 2:
  1119. *(u16 *)c->dst.ptr = (u16)c->dst.val;
  1120. break;
  1121. case 4:
  1122. *c->dst.ptr = (u32)c->dst.val;
  1123. break; /* 64b: zero-ext */
  1124. case 8:
  1125. *c->dst.ptr = c->dst.val;
  1126. break;
  1127. }
  1128. break;
  1129. case OP_MEM:
  1130. if (c->lock_prefix)
  1131. rc = ops->cmpxchg_emulated(
  1132. (unsigned long)c->dst.ptr,
  1133. &c->dst.orig_val,
  1134. &c->dst.val,
  1135. c->dst.bytes,
  1136. ctxt->vcpu);
  1137. else
  1138. rc = ops->write_emulated(
  1139. (unsigned long)c->dst.ptr,
  1140. &c->dst.val,
  1141. c->dst.bytes,
  1142. ctxt->vcpu);
  1143. if (rc != 0)
  1144. return rc;
  1145. break;
  1146. case OP_NONE:
  1147. /* no writeback */
  1148. break;
  1149. default:
  1150. break;
  1151. }
  1152. return 0;
  1153. }
  1154. int
  1155. x86_emulate_insn(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops)
  1156. {
  1157. unsigned long memop = 0;
  1158. u64 msr_data;
  1159. unsigned long saved_eip = 0;
  1160. struct decode_cache *c = &ctxt->decode;
  1161. unsigned int port;
  1162. int io_dir_in;
  1163. int rc = 0;
  1164. /* Shadow copy of register state. Committed on successful emulation.
  1165. * NOTE: we can copy them from vcpu as x86_decode_insn() doesn't
  1166. * modify them.
  1167. */
  1168. memcpy(c->regs, ctxt->vcpu->arch.regs, sizeof c->regs);
  1169. saved_eip = c->eip;
  1170. if (((c->d & ModRM) && (c->modrm_mod != 3)) || (c->d & MemAbs))
  1171. memop = c->modrm_ea;
  1172. if (c->rep_prefix && (c->d & String)) {
  1173. /* All REP prefixes have the same first termination condition */
  1174. if (c->regs[VCPU_REGS_RCX] == 0) {
  1175. kvm_rip_write(ctxt->vcpu, c->eip);
  1176. goto done;
  1177. }
  1178. /* The second termination condition only applies for REPE
  1179. * and REPNE. Test if the repeat string operation prefix is
  1180. * REPE/REPZ or REPNE/REPNZ and if it's the case it tests the
  1181. * corresponding termination condition according to:
  1182. * - if REPE/REPZ and ZF = 0 then done
  1183. * - if REPNE/REPNZ and ZF = 1 then done
  1184. */
  1185. if ((c->b == 0xa6) || (c->b == 0xa7) ||
  1186. (c->b == 0xae) || (c->b == 0xaf)) {
  1187. if ((c->rep_prefix == REPE_PREFIX) &&
  1188. ((ctxt->eflags & EFLG_ZF) == 0)) {
  1189. kvm_rip_write(ctxt->vcpu, c->eip);
  1190. goto done;
  1191. }
  1192. if ((c->rep_prefix == REPNE_PREFIX) &&
  1193. ((ctxt->eflags & EFLG_ZF) == EFLG_ZF)) {
  1194. kvm_rip_write(ctxt->vcpu, c->eip);
  1195. goto done;
  1196. }
  1197. }
  1198. c->regs[VCPU_REGS_RCX]--;
  1199. c->eip = kvm_rip_read(ctxt->vcpu);
  1200. }
  1201. if (c->src.type == OP_MEM) {
  1202. c->src.ptr = (unsigned long *)memop;
  1203. c->src.val = 0;
  1204. rc = ops->read_emulated((unsigned long)c->src.ptr,
  1205. &c->src.val,
  1206. c->src.bytes,
  1207. ctxt->vcpu);
  1208. if (rc != 0)
  1209. goto done;
  1210. c->src.orig_val = c->src.val;
  1211. }
  1212. if ((c->d & DstMask) == ImplicitOps)
  1213. goto special_insn;
  1214. if (c->dst.type == OP_MEM) {
  1215. c->dst.ptr = (unsigned long *)memop;
  1216. c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
  1217. c->dst.val = 0;
  1218. if (c->d & BitOp) {
  1219. unsigned long mask = ~(c->dst.bytes * 8 - 1);
  1220. c->dst.ptr = (void *)c->dst.ptr +
  1221. (c->src.val & mask) / 8;
  1222. }
  1223. if (!(c->d & Mov) &&
  1224. /* optimisation - avoid slow emulated read */
  1225. ((rc = ops->read_emulated((unsigned long)c->dst.ptr,
  1226. &c->dst.val,
  1227. c->dst.bytes, ctxt->vcpu)) != 0))
  1228. goto done;
  1229. }
  1230. c->dst.orig_val = c->dst.val;
  1231. special_insn:
  1232. if (c->twobyte)
  1233. goto twobyte_insn;
  1234. switch (c->b) {
  1235. case 0x00 ... 0x05:
  1236. add: /* add */
  1237. emulate_2op_SrcV("add", c->src, c->dst, ctxt->eflags);
  1238. break;
  1239. case 0x08 ... 0x0d:
  1240. or: /* or */
  1241. emulate_2op_SrcV("or", c->src, c->dst, ctxt->eflags);
  1242. break;
  1243. case 0x10 ... 0x15:
  1244. adc: /* adc */
  1245. emulate_2op_SrcV("adc", c->src, c->dst, ctxt->eflags);
  1246. break;
  1247. case 0x18 ... 0x1d:
  1248. sbb: /* sbb */
  1249. emulate_2op_SrcV("sbb", c->src, c->dst, ctxt->eflags);
  1250. break;
  1251. case 0x20 ... 0x25:
  1252. and: /* and */
  1253. emulate_2op_SrcV("and", c->src, c->dst, ctxt->eflags);
  1254. break;
  1255. case 0x28 ... 0x2d:
  1256. sub: /* sub */
  1257. emulate_2op_SrcV("sub", c->src, c->dst, ctxt->eflags);
  1258. break;
  1259. case 0x30 ... 0x35:
  1260. xor: /* xor */
  1261. emulate_2op_SrcV("xor", c->src, c->dst, ctxt->eflags);
  1262. break;
  1263. case 0x38 ... 0x3d:
  1264. cmp: /* cmp */
  1265. emulate_2op_SrcV("cmp", c->src, c->dst, ctxt->eflags);
  1266. break;
  1267. case 0x40 ... 0x47: /* inc r16/r32 */
  1268. emulate_1op("inc", c->dst, ctxt->eflags);
  1269. break;
  1270. case 0x48 ... 0x4f: /* dec r16/r32 */
  1271. emulate_1op("dec", c->dst, ctxt->eflags);
  1272. break;
  1273. case 0x50 ... 0x57: /* push reg */
  1274. emulate_push(ctxt);
  1275. break;
  1276. case 0x58 ... 0x5f: /* pop reg */
  1277. pop_instruction:
  1278. c->src.bytes = c->op_bytes;
  1279. rc = emulate_pop(ctxt, ops);
  1280. if (rc != 0)
  1281. goto done;
  1282. c->dst.val = c->src.val;
  1283. break;
  1284. case 0x63: /* movsxd */
  1285. if (ctxt->mode != X86EMUL_MODE_PROT64)
  1286. goto cannot_emulate;
  1287. c->dst.val = (s32) c->src.val;
  1288. break;
  1289. case 0x68: /* push imm */
  1290. case 0x6a: /* push imm8 */
  1291. emulate_push(ctxt);
  1292. break;
  1293. case 0x6c: /* insb */
  1294. case 0x6d: /* insw/insd */
  1295. if (kvm_emulate_pio_string(ctxt->vcpu, NULL,
  1296. 1,
  1297. (c->d & ByteOp) ? 1 : c->op_bytes,
  1298. c->rep_prefix ?
  1299. address_mask(c, c->regs[VCPU_REGS_RCX]) : 1,
  1300. (ctxt->eflags & EFLG_DF),
  1301. register_address(c, es_base(ctxt),
  1302. c->regs[VCPU_REGS_RDI]),
  1303. c->rep_prefix,
  1304. c->regs[VCPU_REGS_RDX]) == 0) {
  1305. c->eip = saved_eip;
  1306. return -1;
  1307. }
  1308. return 0;
  1309. case 0x6e: /* outsb */
  1310. case 0x6f: /* outsw/outsd */
  1311. if (kvm_emulate_pio_string(ctxt->vcpu, NULL,
  1312. 0,
  1313. (c->d & ByteOp) ? 1 : c->op_bytes,
  1314. c->rep_prefix ?
  1315. address_mask(c, c->regs[VCPU_REGS_RCX]) : 1,
  1316. (ctxt->eflags & EFLG_DF),
  1317. register_address(c,
  1318. seg_override_base(ctxt, c),
  1319. c->regs[VCPU_REGS_RSI]),
  1320. c->rep_prefix,
  1321. c->regs[VCPU_REGS_RDX]) == 0) {
  1322. c->eip = saved_eip;
  1323. return -1;
  1324. }
  1325. return 0;
  1326. case 0x70 ... 0x7f: /* jcc (short) */ {
  1327. int rel = insn_fetch(s8, 1, c->eip);
  1328. if (test_cc(c->b, ctxt->eflags))
  1329. jmp_rel(c, rel);
  1330. break;
  1331. }
  1332. case 0x80 ... 0x83: /* Grp1 */
  1333. switch (c->modrm_reg) {
  1334. case 0:
  1335. goto add;
  1336. case 1:
  1337. goto or;
  1338. case 2:
  1339. goto adc;
  1340. case 3:
  1341. goto sbb;
  1342. case 4:
  1343. goto and;
  1344. case 5:
  1345. goto sub;
  1346. case 6:
  1347. goto xor;
  1348. case 7:
  1349. goto cmp;
  1350. }
  1351. break;
  1352. case 0x84 ... 0x85:
  1353. emulate_2op_SrcV("test", c->src, c->dst, ctxt->eflags);
  1354. break;
  1355. case 0x86 ... 0x87: /* xchg */
  1356. xchg:
  1357. /* Write back the register source. */
  1358. switch (c->dst.bytes) {
  1359. case 1:
  1360. *(u8 *) c->src.ptr = (u8) c->dst.val;
  1361. break;
  1362. case 2:
  1363. *(u16 *) c->src.ptr = (u16) c->dst.val;
  1364. break;
  1365. case 4:
  1366. *c->src.ptr = (u32) c->dst.val;
  1367. break; /* 64b reg: zero-extend */
  1368. case 8:
  1369. *c->src.ptr = c->dst.val;
  1370. break;
  1371. }
  1372. /*
  1373. * Write back the memory destination with implicit LOCK
  1374. * prefix.
  1375. */
  1376. c->dst.val = c->src.val;
  1377. c->lock_prefix = 1;
  1378. break;
  1379. case 0x88 ... 0x8b: /* mov */
  1380. goto mov;
  1381. case 0x8c: { /* mov r/m, sreg */
  1382. struct kvm_segment segreg;
  1383. if (c->modrm_reg <= 5)
  1384. kvm_get_segment(ctxt->vcpu, &segreg, c->modrm_reg);
  1385. else {
  1386. printk(KERN_INFO "0x8c: Invalid segreg in modrm byte 0x%02x\n",
  1387. c->modrm);
  1388. goto cannot_emulate;
  1389. }
  1390. c->dst.val = segreg.selector;
  1391. break;
  1392. }
  1393. case 0x8d: /* lea r16/r32, m */
  1394. c->dst.val = c->modrm_ea;
  1395. break;
  1396. case 0x8e: { /* mov seg, r/m16 */
  1397. uint16_t sel;
  1398. int type_bits;
  1399. int err;
  1400. sel = c->src.val;
  1401. if (c->modrm_reg <= 5) {
  1402. type_bits = (c->modrm_reg == 1) ? 9 : 1;
  1403. err = kvm_load_segment_descriptor(ctxt->vcpu, sel,
  1404. type_bits, c->modrm_reg);
  1405. } else {
  1406. printk(KERN_INFO "Invalid segreg in modrm byte 0x%02x\n",
  1407. c->modrm);
  1408. goto cannot_emulate;
  1409. }
  1410. if (err < 0)
  1411. goto cannot_emulate;
  1412. c->dst.type = OP_NONE; /* Disable writeback. */
  1413. break;
  1414. }
  1415. case 0x8f: /* pop (sole member of Grp1a) */
  1416. rc = emulate_grp1a(ctxt, ops);
  1417. if (rc != 0)
  1418. goto done;
  1419. break;
  1420. case 0x90: /* nop / xchg r8,rax */
  1421. if (!(c->rex_prefix & 1)) { /* nop */
  1422. c->dst.type = OP_NONE;
  1423. break;
  1424. }
  1425. case 0x91 ... 0x97: /* xchg reg,rax */
  1426. c->src.type = c->dst.type = OP_REG;
  1427. c->src.bytes = c->dst.bytes = c->op_bytes;
  1428. c->src.ptr = (unsigned long *) &c->regs[VCPU_REGS_RAX];
  1429. c->src.val = *(c->src.ptr);
  1430. goto xchg;
  1431. case 0x9c: /* pushf */
  1432. c->src.val = (unsigned long) ctxt->eflags;
  1433. emulate_push(ctxt);
  1434. break;
  1435. case 0x9d: /* popf */
  1436. c->dst.ptr = (unsigned long *) &ctxt->eflags;
  1437. goto pop_instruction;
  1438. case 0xa0 ... 0xa1: /* mov */
  1439. c->dst.ptr = (unsigned long *)&c->regs[VCPU_REGS_RAX];
  1440. c->dst.val = c->src.val;
  1441. break;
  1442. case 0xa2 ... 0xa3: /* mov */
  1443. c->dst.val = (unsigned long)c->regs[VCPU_REGS_RAX];
  1444. break;
  1445. case 0xa4 ... 0xa5: /* movs */
  1446. c->dst.type = OP_MEM;
  1447. c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
  1448. c->dst.ptr = (unsigned long *)register_address(c,
  1449. es_base(ctxt),
  1450. c->regs[VCPU_REGS_RDI]);
  1451. if ((rc = ops->read_emulated(register_address(c,
  1452. seg_override_base(ctxt, c),
  1453. c->regs[VCPU_REGS_RSI]),
  1454. &c->dst.val,
  1455. c->dst.bytes, ctxt->vcpu)) != 0)
  1456. goto done;
  1457. register_address_increment(c, &c->regs[VCPU_REGS_RSI],
  1458. (ctxt->eflags & EFLG_DF) ? -c->dst.bytes
  1459. : c->dst.bytes);
  1460. register_address_increment(c, &c->regs[VCPU_REGS_RDI],
  1461. (ctxt->eflags & EFLG_DF) ? -c->dst.bytes
  1462. : c->dst.bytes);
  1463. break;
  1464. case 0xa6 ... 0xa7: /* cmps */
  1465. c->src.type = OP_NONE; /* Disable writeback. */
  1466. c->src.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
  1467. c->src.ptr = (unsigned long *)register_address(c,
  1468. seg_override_base(ctxt, c),
  1469. c->regs[VCPU_REGS_RSI]);
  1470. if ((rc = ops->read_emulated((unsigned long)c->src.ptr,
  1471. &c->src.val,
  1472. c->src.bytes,
  1473. ctxt->vcpu)) != 0)
  1474. goto done;
  1475. c->dst.type = OP_NONE; /* Disable writeback. */
  1476. c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
  1477. c->dst.ptr = (unsigned long *)register_address(c,
  1478. es_base(ctxt),
  1479. c->regs[VCPU_REGS_RDI]);
  1480. if ((rc = ops->read_emulated((unsigned long)c->dst.ptr,
  1481. &c->dst.val,
  1482. c->dst.bytes,
  1483. ctxt->vcpu)) != 0)
  1484. goto done;
  1485. DPRINTF("cmps: mem1=0x%p mem2=0x%p\n", c->src.ptr, c->dst.ptr);
  1486. emulate_2op_SrcV("cmp", c->src, c->dst, ctxt->eflags);
  1487. register_address_increment(c, &c->regs[VCPU_REGS_RSI],
  1488. (ctxt->eflags & EFLG_DF) ? -c->src.bytes
  1489. : c->src.bytes);
  1490. register_address_increment(c, &c->regs[VCPU_REGS_RDI],
  1491. (ctxt->eflags & EFLG_DF) ? -c->dst.bytes
  1492. : c->dst.bytes);
  1493. break;
  1494. case 0xaa ... 0xab: /* stos */
  1495. c->dst.type = OP_MEM;
  1496. c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
  1497. c->dst.ptr = (unsigned long *)register_address(c,
  1498. es_base(ctxt),
  1499. c->regs[VCPU_REGS_RDI]);
  1500. c->dst.val = c->regs[VCPU_REGS_RAX];
  1501. register_address_increment(c, &c->regs[VCPU_REGS_RDI],
  1502. (ctxt->eflags & EFLG_DF) ? -c->dst.bytes
  1503. : c->dst.bytes);
  1504. break;
  1505. case 0xac ... 0xad: /* lods */
  1506. c->dst.type = OP_REG;
  1507. c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
  1508. c->dst.ptr = (unsigned long *)&c->regs[VCPU_REGS_RAX];
  1509. if ((rc = ops->read_emulated(register_address(c,
  1510. seg_override_base(ctxt, c),
  1511. c->regs[VCPU_REGS_RSI]),
  1512. &c->dst.val,
  1513. c->dst.bytes,
  1514. ctxt->vcpu)) != 0)
  1515. goto done;
  1516. register_address_increment(c, &c->regs[VCPU_REGS_RSI],
  1517. (ctxt->eflags & EFLG_DF) ? -c->dst.bytes
  1518. : c->dst.bytes);
  1519. break;
  1520. case 0xae ... 0xaf: /* scas */
  1521. DPRINTF("Urk! I don't handle SCAS.\n");
  1522. goto cannot_emulate;
  1523. case 0xb0 ... 0xbf: /* mov r, imm */
  1524. goto mov;
  1525. case 0xc0 ... 0xc1:
  1526. emulate_grp2(ctxt);
  1527. break;
  1528. case 0xc3: /* ret */
  1529. c->dst.ptr = &c->eip;
  1530. goto pop_instruction;
  1531. case 0xc6 ... 0xc7: /* mov (sole member of Grp11) */
  1532. mov:
  1533. c->dst.val = c->src.val;
  1534. break;
  1535. case 0xd0 ... 0xd1: /* Grp2 */
  1536. c->src.val = 1;
  1537. emulate_grp2(ctxt);
  1538. break;
  1539. case 0xd2 ... 0xd3: /* Grp2 */
  1540. c->src.val = c->regs[VCPU_REGS_RCX];
  1541. emulate_grp2(ctxt);
  1542. break;
  1543. case 0xe4: /* inb */
  1544. case 0xe5: /* in */
  1545. port = insn_fetch(u8, 1, c->eip);
  1546. io_dir_in = 1;
  1547. goto do_io;
  1548. case 0xe6: /* outb */
  1549. case 0xe7: /* out */
  1550. port = insn_fetch(u8, 1, c->eip);
  1551. io_dir_in = 0;
  1552. goto do_io;
  1553. case 0xe8: /* call (near) */ {
  1554. long int rel;
  1555. switch (c->op_bytes) {
  1556. case 2:
  1557. rel = insn_fetch(s16, 2, c->eip);
  1558. break;
  1559. case 4:
  1560. rel = insn_fetch(s32, 4, c->eip);
  1561. break;
  1562. default:
  1563. DPRINTF("Call: Invalid op_bytes\n");
  1564. goto cannot_emulate;
  1565. }
  1566. c->src.val = (unsigned long) c->eip;
  1567. jmp_rel(c, rel);
  1568. c->op_bytes = c->ad_bytes;
  1569. emulate_push(ctxt);
  1570. break;
  1571. }
  1572. case 0xe9: /* jmp rel */
  1573. goto jmp;
  1574. case 0xea: /* jmp far */ {
  1575. uint32_t eip;
  1576. uint16_t sel;
  1577. switch (c->op_bytes) {
  1578. case 2:
  1579. eip = insn_fetch(u16, 2, c->eip);
  1580. break;
  1581. case 4:
  1582. eip = insn_fetch(u32, 4, c->eip);
  1583. break;
  1584. default:
  1585. DPRINTF("jmp far: Invalid op_bytes\n");
  1586. goto cannot_emulate;
  1587. }
  1588. sel = insn_fetch(u16, 2, c->eip);
  1589. if (kvm_load_segment_descriptor(ctxt->vcpu, sel, 9, VCPU_SREG_CS) < 0) {
  1590. DPRINTF("jmp far: Failed to load CS descriptor\n");
  1591. goto cannot_emulate;
  1592. }
  1593. c->eip = eip;
  1594. break;
  1595. }
  1596. case 0xeb:
  1597. jmp: /* jmp rel short */
  1598. jmp_rel(c, c->src.val);
  1599. c->dst.type = OP_NONE; /* Disable writeback. */
  1600. break;
  1601. case 0xec: /* in al,dx */
  1602. case 0xed: /* in (e/r)ax,dx */
  1603. port = c->regs[VCPU_REGS_RDX];
  1604. io_dir_in = 1;
  1605. goto do_io;
  1606. case 0xee: /* out al,dx */
  1607. case 0xef: /* out (e/r)ax,dx */
  1608. port = c->regs[VCPU_REGS_RDX];
  1609. io_dir_in = 0;
  1610. do_io: if (kvm_emulate_pio(ctxt->vcpu, NULL, io_dir_in,
  1611. (c->d & ByteOp) ? 1 : c->op_bytes,
  1612. port) != 0) {
  1613. c->eip = saved_eip;
  1614. goto cannot_emulate;
  1615. }
  1616. break;
  1617. case 0xf4: /* hlt */
  1618. ctxt->vcpu->arch.halt_request = 1;
  1619. break;
  1620. case 0xf5: /* cmc */
  1621. /* complement carry flag from eflags reg */
  1622. ctxt->eflags ^= EFLG_CF;
  1623. c->dst.type = OP_NONE; /* Disable writeback. */
  1624. break;
  1625. case 0xf6 ... 0xf7: /* Grp3 */
  1626. rc = emulate_grp3(ctxt, ops);
  1627. if (rc != 0)
  1628. goto done;
  1629. break;
  1630. case 0xf8: /* clc */
  1631. ctxt->eflags &= ~EFLG_CF;
  1632. c->dst.type = OP_NONE; /* Disable writeback. */
  1633. break;
  1634. case 0xfa: /* cli */
  1635. ctxt->eflags &= ~X86_EFLAGS_IF;
  1636. c->dst.type = OP_NONE; /* Disable writeback. */
  1637. break;
  1638. case 0xfb: /* sti */
  1639. ctxt->eflags |= X86_EFLAGS_IF;
  1640. c->dst.type = OP_NONE; /* Disable writeback. */
  1641. break;
  1642. case 0xfc: /* cld */
  1643. ctxt->eflags &= ~EFLG_DF;
  1644. c->dst.type = OP_NONE; /* Disable writeback. */
  1645. break;
  1646. case 0xfd: /* std */
  1647. ctxt->eflags |= EFLG_DF;
  1648. c->dst.type = OP_NONE; /* Disable writeback. */
  1649. break;
  1650. case 0xfe ... 0xff: /* Grp4/Grp5 */
  1651. rc = emulate_grp45(ctxt, ops);
  1652. if (rc != 0)
  1653. goto done;
  1654. break;
  1655. }
  1656. writeback:
  1657. rc = writeback(ctxt, ops);
  1658. if (rc != 0)
  1659. goto done;
  1660. /* Commit shadow register state. */
  1661. memcpy(ctxt->vcpu->arch.regs, c->regs, sizeof c->regs);
  1662. kvm_rip_write(ctxt->vcpu, c->eip);
  1663. done:
  1664. if (rc == X86EMUL_UNHANDLEABLE) {
  1665. c->eip = saved_eip;
  1666. return -1;
  1667. }
  1668. return 0;
  1669. twobyte_insn:
  1670. switch (c->b) {
  1671. case 0x01: /* lgdt, lidt, lmsw */
  1672. switch (c->modrm_reg) {
  1673. u16 size;
  1674. unsigned long address;
  1675. case 0: /* vmcall */
  1676. if (c->modrm_mod != 3 || c->modrm_rm != 1)
  1677. goto cannot_emulate;
  1678. rc = kvm_fix_hypercall(ctxt->vcpu);
  1679. if (rc)
  1680. goto done;
  1681. /* Let the processor re-execute the fixed hypercall */
  1682. c->eip = kvm_rip_read(ctxt->vcpu);
  1683. /* Disable writeback. */
  1684. c->dst.type = OP_NONE;
  1685. break;
  1686. case 2: /* lgdt */
  1687. rc = read_descriptor(ctxt, ops, c->src.ptr,
  1688. &size, &address, c->op_bytes);
  1689. if (rc)
  1690. goto done;
  1691. realmode_lgdt(ctxt->vcpu, size, address);
  1692. /* Disable writeback. */
  1693. c->dst.type = OP_NONE;
  1694. break;
  1695. case 3: /* lidt/vmmcall */
  1696. if (c->modrm_mod == 3 && c->modrm_rm == 1) {
  1697. rc = kvm_fix_hypercall(ctxt->vcpu);
  1698. if (rc)
  1699. goto done;
  1700. kvm_emulate_hypercall(ctxt->vcpu);
  1701. } else {
  1702. rc = read_descriptor(ctxt, ops, c->src.ptr,
  1703. &size, &address,
  1704. c->op_bytes);
  1705. if (rc)
  1706. goto done;
  1707. realmode_lidt(ctxt->vcpu, size, address);
  1708. }
  1709. /* Disable writeback. */
  1710. c->dst.type = OP_NONE;
  1711. break;
  1712. case 4: /* smsw */
  1713. c->dst.bytes = 2;
  1714. c->dst.val = realmode_get_cr(ctxt->vcpu, 0);
  1715. break;
  1716. case 6: /* lmsw */
  1717. realmode_lmsw(ctxt->vcpu, (u16)c->src.val,
  1718. &ctxt->eflags);
  1719. c->dst.type = OP_NONE;
  1720. break;
  1721. case 7: /* invlpg*/
  1722. emulate_invlpg(ctxt->vcpu, memop);
  1723. /* Disable writeback. */
  1724. c->dst.type = OP_NONE;
  1725. break;
  1726. default:
  1727. goto cannot_emulate;
  1728. }
  1729. break;
  1730. case 0x06:
  1731. emulate_clts(ctxt->vcpu);
  1732. c->dst.type = OP_NONE;
  1733. break;
  1734. case 0x08: /* invd */
  1735. case 0x09: /* wbinvd */
  1736. case 0x0d: /* GrpP (prefetch) */
  1737. case 0x18: /* Grp16 (prefetch/nop) */
  1738. c->dst.type = OP_NONE;
  1739. break;
  1740. case 0x20: /* mov cr, reg */
  1741. if (c->modrm_mod != 3)
  1742. goto cannot_emulate;
  1743. c->regs[c->modrm_rm] =
  1744. realmode_get_cr(ctxt->vcpu, c->modrm_reg);
  1745. c->dst.type = OP_NONE; /* no writeback */
  1746. break;
  1747. case 0x21: /* mov from dr to reg */
  1748. if (c->modrm_mod != 3)
  1749. goto cannot_emulate;
  1750. rc = emulator_get_dr(ctxt, c->modrm_reg, &c->regs[c->modrm_rm]);
  1751. if (rc)
  1752. goto cannot_emulate;
  1753. c->dst.type = OP_NONE; /* no writeback */
  1754. break;
  1755. case 0x22: /* mov reg, cr */
  1756. if (c->modrm_mod != 3)
  1757. goto cannot_emulate;
  1758. realmode_set_cr(ctxt->vcpu,
  1759. c->modrm_reg, c->modrm_val, &ctxt->eflags);
  1760. c->dst.type = OP_NONE;
  1761. break;
  1762. case 0x23: /* mov from reg to dr */
  1763. if (c->modrm_mod != 3)
  1764. goto cannot_emulate;
  1765. rc = emulator_set_dr(ctxt, c->modrm_reg,
  1766. c->regs[c->modrm_rm]);
  1767. if (rc)
  1768. goto cannot_emulate;
  1769. c->dst.type = OP_NONE; /* no writeback */
  1770. break;
  1771. case 0x30:
  1772. /* wrmsr */
  1773. msr_data = (u32)c->regs[VCPU_REGS_RAX]
  1774. | ((u64)c->regs[VCPU_REGS_RDX] << 32);
  1775. rc = kvm_set_msr(ctxt->vcpu, c->regs[VCPU_REGS_RCX], msr_data);
  1776. if (rc) {
  1777. kvm_inject_gp(ctxt->vcpu, 0);
  1778. c->eip = kvm_rip_read(ctxt->vcpu);
  1779. }
  1780. rc = X86EMUL_CONTINUE;
  1781. c->dst.type = OP_NONE;
  1782. break;
  1783. case 0x32:
  1784. /* rdmsr */
  1785. rc = kvm_get_msr(ctxt->vcpu, c->regs[VCPU_REGS_RCX], &msr_data);
  1786. if (rc) {
  1787. kvm_inject_gp(ctxt->vcpu, 0);
  1788. c->eip = kvm_rip_read(ctxt->vcpu);
  1789. } else {
  1790. c->regs[VCPU_REGS_RAX] = (u32)msr_data;
  1791. c->regs[VCPU_REGS_RDX] = msr_data >> 32;
  1792. }
  1793. rc = X86EMUL_CONTINUE;
  1794. c->dst.type = OP_NONE;
  1795. break;
  1796. case 0x40 ... 0x4f: /* cmov */
  1797. c->dst.val = c->dst.orig_val = c->src.val;
  1798. if (!test_cc(c->b, ctxt->eflags))
  1799. c->dst.type = OP_NONE; /* no writeback */
  1800. break;
  1801. case 0x80 ... 0x8f: /* jnz rel, etc*/ {
  1802. long int rel;
  1803. switch (c->op_bytes) {
  1804. case 2:
  1805. rel = insn_fetch(s16, 2, c->eip);
  1806. break;
  1807. case 4:
  1808. rel = insn_fetch(s32, 4, c->eip);
  1809. break;
  1810. case 8:
  1811. rel = insn_fetch(s64, 8, c->eip);
  1812. break;
  1813. default:
  1814. DPRINTF("jnz: Invalid op_bytes\n");
  1815. goto cannot_emulate;
  1816. }
  1817. if (test_cc(c->b, ctxt->eflags))
  1818. jmp_rel(c, rel);
  1819. c->dst.type = OP_NONE;
  1820. break;
  1821. }
  1822. case 0xa3:
  1823. bt: /* bt */
  1824. c->dst.type = OP_NONE;
  1825. /* only subword offset */
  1826. c->src.val &= (c->dst.bytes << 3) - 1;
  1827. emulate_2op_SrcV_nobyte("bt", c->src, c->dst, ctxt->eflags);
  1828. break;
  1829. case 0xab:
  1830. bts: /* bts */
  1831. /* only subword offset */
  1832. c->src.val &= (c->dst.bytes << 3) - 1;
  1833. emulate_2op_SrcV_nobyte("bts", c->src, c->dst, ctxt->eflags);
  1834. break;
  1835. case 0xae: /* clflush */
  1836. break;
  1837. case 0xb0 ... 0xb1: /* cmpxchg */
  1838. /*
  1839. * Save real source value, then compare EAX against
  1840. * destination.
  1841. */
  1842. c->src.orig_val = c->src.val;
  1843. c->src.val = c->regs[VCPU_REGS_RAX];
  1844. emulate_2op_SrcV("cmp", c->src, c->dst, ctxt->eflags);
  1845. if (ctxt->eflags & EFLG_ZF) {
  1846. /* Success: write back to memory. */
  1847. c->dst.val = c->src.orig_val;
  1848. } else {
  1849. /* Failure: write the value we saw to EAX. */
  1850. c->dst.type = OP_REG;
  1851. c->dst.ptr = (unsigned long *)&c->regs[VCPU_REGS_RAX];
  1852. }
  1853. break;
  1854. case 0xb3:
  1855. btr: /* btr */
  1856. /* only subword offset */
  1857. c->src.val &= (c->dst.bytes << 3) - 1;
  1858. emulate_2op_SrcV_nobyte("btr", c->src, c->dst, ctxt->eflags);
  1859. break;
  1860. case 0xb6 ... 0xb7: /* movzx */
  1861. c->dst.bytes = c->op_bytes;
  1862. c->dst.val = (c->d & ByteOp) ? (u8) c->src.val
  1863. : (u16) c->src.val;
  1864. break;
  1865. case 0xba: /* Grp8 */
  1866. switch (c->modrm_reg & 3) {
  1867. case 0:
  1868. goto bt;
  1869. case 1:
  1870. goto bts;
  1871. case 2:
  1872. goto btr;
  1873. case 3:
  1874. goto btc;
  1875. }
  1876. break;
  1877. case 0xbb:
  1878. btc: /* btc */
  1879. /* only subword offset */
  1880. c->src.val &= (c->dst.bytes << 3) - 1;
  1881. emulate_2op_SrcV_nobyte("btc", c->src, c->dst, ctxt->eflags);
  1882. break;
  1883. case 0xbe ... 0xbf: /* movsx */
  1884. c->dst.bytes = c->op_bytes;
  1885. c->dst.val = (c->d & ByteOp) ? (s8) c->src.val :
  1886. (s16) c->src.val;
  1887. break;
  1888. case 0xc3: /* movnti */
  1889. c->dst.bytes = c->op_bytes;
  1890. c->dst.val = (c->op_bytes == 4) ? (u32) c->src.val :
  1891. (u64) c->src.val;
  1892. break;
  1893. case 0xc7: /* Grp9 (cmpxchg8b) */
  1894. rc = emulate_grp9(ctxt, ops, memop);
  1895. if (rc != 0)
  1896. goto done;
  1897. c->dst.type = OP_NONE;
  1898. break;
  1899. }
  1900. goto writeback;
  1901. cannot_emulate:
  1902. DPRINTF("Cannot emulate %02x\n", c->b);
  1903. c->eip = saved_eip;
  1904. return -1;
  1905. }