2
0

vga.c 69 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320
  1. /*
  2. * QEMU VGA Emulator.
  3. *
  4. * Copyright (c) 2003 Fabrice Bellard
  5. *
  6. * Permission is hereby granted, free of charge, to any person obtaining a copy
  7. * of this software and associated documentation files (the "Software"), to deal
  8. * in the Software without restriction, including without limitation the rights
  9. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10. * copies of the Software, and to permit persons to whom the Software is
  11. * furnished to do so, subject to the following conditions:
  12. *
  13. * The above copyright notice and this permission notice shall be included in
  14. * all copies or substantial portions of the Software.
  15. *
  16. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22. * THE SOFTWARE.
  23. */
  24. #include "qemu/osdep.h"
  25. #include "qemu/units.h"
  26. #include "sysemu/reset.h"
  27. #include "qapi/error.h"
  28. #include "hw/display/vga.h"
  29. #include "hw/pci/pci.h"
  30. #include "vga_int.h"
  31. #include "vga_regs.h"
  32. #include "ui/pixel_ops.h"
  33. #include "ui/console.h"
  34. #include "qemu/timer.h"
  35. #include "hw/xen/xen.h"
  36. #include "migration/vmstate.h"
  37. #include "trace.h"
  38. //#define DEBUG_VGA_MEM
  39. //#define DEBUG_VGA_REG
  40. bool have_vga = true;
  41. /* 16 state changes per vertical frame @60 Hz */
  42. #define VGA_TEXT_CURSOR_PERIOD_MS (1000 * 2 * 16 / 60)
  43. /*
  44. * Video Graphics Array (VGA)
  45. *
  46. * Chipset docs for original IBM VGA:
  47. * http://www.mcamafia.de/pdf/ibm_vgaxga_trm2.pdf
  48. *
  49. * FreeVGA site:
  50. * http://www.osdever.net/FreeVGA/home.htm
  51. *
  52. * Standard VGA features and Bochs VBE extensions are implemented.
  53. */
  54. /* force some bits to zero */
  55. const uint8_t sr_mask[8] = {
  56. 0x03,
  57. 0x3d,
  58. 0x0f,
  59. 0x3f,
  60. 0x0e,
  61. 0x00,
  62. 0x00,
  63. 0xff,
  64. };
  65. const uint8_t gr_mask[16] = {
  66. 0x0f, /* 0x00 */
  67. 0x0f, /* 0x01 */
  68. 0x0f, /* 0x02 */
  69. 0x1f, /* 0x03 */
  70. 0x03, /* 0x04 */
  71. 0x7b, /* 0x05 */
  72. 0x0f, /* 0x06 */
  73. 0x0f, /* 0x07 */
  74. 0xff, /* 0x08 */
  75. 0x00, /* 0x09 */
  76. 0x00, /* 0x0a */
  77. 0x00, /* 0x0b */
  78. 0x00, /* 0x0c */
  79. 0x00, /* 0x0d */
  80. 0x00, /* 0x0e */
  81. 0x00, /* 0x0f */
  82. };
  83. #define cbswap_32(__x) \
  84. ((uint32_t)( \
  85. (((uint32_t)(__x) & (uint32_t)0x000000ffUL) << 24) | \
  86. (((uint32_t)(__x) & (uint32_t)0x0000ff00UL) << 8) | \
  87. (((uint32_t)(__x) & (uint32_t)0x00ff0000UL) >> 8) | \
  88. (((uint32_t)(__x) & (uint32_t)0xff000000UL) >> 24) ))
  89. #if HOST_BIG_ENDIAN
  90. #define PAT(x) cbswap_32(x)
  91. #else
  92. #define PAT(x) (x)
  93. #endif
  94. #if HOST_BIG_ENDIAN
  95. #define BIG 1
  96. #else
  97. #define BIG 0
  98. #endif
  99. #if HOST_BIG_ENDIAN
  100. #define GET_PLANE(data, p) (((data) >> (24 - (p) * 8)) & 0xff)
  101. #else
  102. #define GET_PLANE(data, p) (((data) >> ((p) * 8)) & 0xff)
  103. #endif
  104. static const uint32_t mask16[16] = {
  105. PAT(0x00000000),
  106. PAT(0x000000ff),
  107. PAT(0x0000ff00),
  108. PAT(0x0000ffff),
  109. PAT(0x00ff0000),
  110. PAT(0x00ff00ff),
  111. PAT(0x00ffff00),
  112. PAT(0x00ffffff),
  113. PAT(0xff000000),
  114. PAT(0xff0000ff),
  115. PAT(0xff00ff00),
  116. PAT(0xff00ffff),
  117. PAT(0xffff0000),
  118. PAT(0xffff00ff),
  119. PAT(0xffffff00),
  120. PAT(0xffffffff),
  121. };
  122. #undef PAT
  123. #if HOST_BIG_ENDIAN
  124. #define PAT(x) (x)
  125. #else
  126. #define PAT(x) cbswap_32(x)
  127. #endif
  128. static uint32_t expand4[256];
  129. static uint16_t expand2[256];
  130. static uint8_t expand4to8[16];
  131. static void vbe_update_vgaregs(VGACommonState *s);
  132. static inline bool vbe_enabled(VGACommonState *s)
  133. {
  134. return s->vbe_regs[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_ENABLED;
  135. }
  136. static inline uint8_t sr(VGACommonState *s, int idx)
  137. {
  138. return vbe_enabled(s) ? s->sr_vbe[idx] : s->sr[idx];
  139. }
  140. static void vga_update_memory_access(VGACommonState *s)
  141. {
  142. hwaddr base, offset, size;
  143. if (s->legacy_address_space == NULL) {
  144. return;
  145. }
  146. if (s->has_chain4_alias) {
  147. memory_region_del_subregion(s->legacy_address_space, &s->chain4_alias);
  148. object_unparent(OBJECT(&s->chain4_alias));
  149. s->has_chain4_alias = false;
  150. s->plane_updated = 0xf;
  151. }
  152. if ((sr(s, VGA_SEQ_PLANE_WRITE) & VGA_SR02_ALL_PLANES) ==
  153. VGA_SR02_ALL_PLANES && sr(s, VGA_SEQ_MEMORY_MODE) & VGA_SR04_CHN_4M) {
  154. offset = 0;
  155. switch ((s->gr[VGA_GFX_MISC] >> 2) & 3) {
  156. case 0:
  157. base = 0xa0000;
  158. size = 0x20000;
  159. break;
  160. case 1:
  161. base = 0xa0000;
  162. size = 0x10000;
  163. offset = s->bank_offset;
  164. break;
  165. case 2:
  166. base = 0xb0000;
  167. size = 0x8000;
  168. break;
  169. case 3:
  170. default:
  171. base = 0xb8000;
  172. size = 0x8000;
  173. break;
  174. }
  175. assert(offset + size <= s->vram_size);
  176. memory_region_init_alias(&s->chain4_alias, memory_region_owner(&s->vram),
  177. "vga.chain4", &s->vram, offset, size);
  178. memory_region_add_subregion_overlap(s->legacy_address_space, base,
  179. &s->chain4_alias, 2);
  180. s->has_chain4_alias = true;
  181. }
  182. }
  183. static void vga_dumb_update_retrace_info(VGACommonState *s)
  184. {
  185. (void) s;
  186. }
  187. static void vga_precise_update_retrace_info(VGACommonState *s)
  188. {
  189. int htotal_chars;
  190. int hretr_start_char;
  191. int hretr_skew_chars;
  192. int hretr_end_char;
  193. int vtotal_lines;
  194. int vretr_start_line;
  195. int vretr_end_line;
  196. int dots;
  197. #if 0
  198. int div2, sldiv2;
  199. #endif
  200. int clocking_mode;
  201. int clock_sel;
  202. const int clk_hz[] = {25175000, 28322000, 25175000, 25175000};
  203. int64_t chars_per_sec;
  204. struct vga_precise_retrace *r = &s->retrace_info.precise;
  205. htotal_chars = s->cr[VGA_CRTC_H_TOTAL] + 5;
  206. hretr_start_char = s->cr[VGA_CRTC_H_SYNC_START];
  207. hretr_skew_chars = (s->cr[VGA_CRTC_H_SYNC_END] >> 5) & 3;
  208. hretr_end_char = s->cr[VGA_CRTC_H_SYNC_END] & 0x1f;
  209. vtotal_lines = (s->cr[VGA_CRTC_V_TOTAL] |
  210. (((s->cr[VGA_CRTC_OVERFLOW] & 1) |
  211. ((s->cr[VGA_CRTC_OVERFLOW] >> 4) & 2)) << 8)) + 2;
  212. vretr_start_line = s->cr[VGA_CRTC_V_SYNC_START] |
  213. ((((s->cr[VGA_CRTC_OVERFLOW] >> 2) & 1) |
  214. ((s->cr[VGA_CRTC_OVERFLOW] >> 6) & 2)) << 8);
  215. vretr_end_line = s->cr[VGA_CRTC_V_SYNC_END] & 0xf;
  216. clocking_mode = (sr(s, VGA_SEQ_CLOCK_MODE) >> 3) & 1;
  217. clock_sel = (s->msr >> 2) & 3;
  218. dots = (s->msr & 1) ? 8 : 9;
  219. chars_per_sec = clk_hz[clock_sel] / dots;
  220. htotal_chars <<= clocking_mode;
  221. r->total_chars = vtotal_lines * htotal_chars;
  222. if (r->freq) {
  223. r->ticks_per_char = NANOSECONDS_PER_SECOND / (r->total_chars * r->freq);
  224. } else {
  225. r->ticks_per_char = NANOSECONDS_PER_SECOND / chars_per_sec;
  226. }
  227. r->vstart = vretr_start_line;
  228. r->vend = r->vstart + vretr_end_line + 1;
  229. r->hstart = hretr_start_char + hretr_skew_chars;
  230. r->hend = r->hstart + hretr_end_char + 1;
  231. r->htotal = htotal_chars;
  232. #if 0
  233. div2 = (s->cr[VGA_CRTC_MODE] >> 2) & 1;
  234. sldiv2 = (s->cr[VGA_CRTC_MODE] >> 3) & 1;
  235. printf (
  236. "hz=%f\n"
  237. "htotal = %d\n"
  238. "hretr_start = %d\n"
  239. "hretr_skew = %d\n"
  240. "hretr_end = %d\n"
  241. "vtotal = %d\n"
  242. "vretr_start = %d\n"
  243. "vretr_end = %d\n"
  244. "div2 = %d sldiv2 = %d\n"
  245. "clocking_mode = %d\n"
  246. "clock_sel = %d %d\n"
  247. "dots = %d\n"
  248. "ticks/char = %" PRId64 "\n"
  249. "\n",
  250. (double) NANOSECONDS_PER_SECOND / (r->ticks_per_char * r->total_chars),
  251. htotal_chars,
  252. hretr_start_char,
  253. hretr_skew_chars,
  254. hretr_end_char,
  255. vtotal_lines,
  256. vretr_start_line,
  257. vretr_end_line,
  258. div2, sldiv2,
  259. clocking_mode,
  260. clock_sel,
  261. clk_hz[clock_sel],
  262. dots,
  263. r->ticks_per_char
  264. );
  265. #endif
  266. }
  267. static uint8_t vga_precise_retrace(VGACommonState *s)
  268. {
  269. struct vga_precise_retrace *r = &s->retrace_info.precise;
  270. uint8_t val = s->st01 & ~(ST01_V_RETRACE | ST01_DISP_ENABLE);
  271. if (r->total_chars) {
  272. int cur_line, cur_line_char, cur_char;
  273. int64_t cur_tick;
  274. cur_tick = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
  275. cur_char = (cur_tick / r->ticks_per_char) % r->total_chars;
  276. cur_line = cur_char / r->htotal;
  277. if (cur_line >= r->vstart && cur_line <= r->vend) {
  278. val |= ST01_V_RETRACE | ST01_DISP_ENABLE;
  279. } else {
  280. cur_line_char = cur_char % r->htotal;
  281. if (cur_line_char >= r->hstart && cur_line_char <= r->hend) {
  282. val |= ST01_DISP_ENABLE;
  283. }
  284. }
  285. return val;
  286. } else {
  287. return s->st01 ^ (ST01_V_RETRACE | ST01_DISP_ENABLE);
  288. }
  289. }
  290. static uint8_t vga_dumb_retrace(VGACommonState *s)
  291. {
  292. return s->st01 ^ (ST01_V_RETRACE | ST01_DISP_ENABLE);
  293. }
  294. int vga_ioport_invalid(VGACommonState *s, uint32_t addr)
  295. {
  296. if (s->msr & VGA_MIS_COLOR) {
  297. /* Color */
  298. return (addr >= 0x3b0 && addr <= 0x3bf);
  299. } else {
  300. /* Monochrome */
  301. return (addr >= 0x3d0 && addr <= 0x3df);
  302. }
  303. }
  304. uint32_t vga_ioport_read(void *opaque, uint32_t addr)
  305. {
  306. VGACommonState *s = opaque;
  307. int val, index;
  308. if (vga_ioport_invalid(s, addr)) {
  309. val = 0xff;
  310. } else {
  311. switch(addr) {
  312. case VGA_ATT_W:
  313. if (s->ar_flip_flop == 0) {
  314. val = s->ar_index;
  315. } else {
  316. val = 0;
  317. }
  318. break;
  319. case VGA_ATT_R:
  320. index = s->ar_index & 0x1f;
  321. if (index < VGA_ATT_C) {
  322. val = s->ar[index];
  323. } else {
  324. val = 0;
  325. }
  326. break;
  327. case VGA_MIS_W:
  328. val = s->st00;
  329. break;
  330. case VGA_SEQ_I:
  331. val = s->sr_index;
  332. break;
  333. case VGA_SEQ_D:
  334. val = s->sr[s->sr_index];
  335. #ifdef DEBUG_VGA_REG
  336. printf("vga: read SR%x = 0x%02x\n", s->sr_index, val);
  337. #endif
  338. break;
  339. case VGA_PEL_IR:
  340. val = s->dac_state;
  341. break;
  342. case VGA_PEL_IW:
  343. val = s->dac_write_index;
  344. break;
  345. case VGA_PEL_D:
  346. val = s->palette[s->dac_read_index * 3 + s->dac_sub_index];
  347. if (++s->dac_sub_index == 3) {
  348. s->dac_sub_index = 0;
  349. s->dac_read_index++;
  350. }
  351. break;
  352. case VGA_FTC_R:
  353. val = s->fcr;
  354. break;
  355. case VGA_MIS_R:
  356. val = s->msr;
  357. break;
  358. case VGA_GFX_I:
  359. val = s->gr_index;
  360. break;
  361. case VGA_GFX_D:
  362. val = s->gr[s->gr_index];
  363. #ifdef DEBUG_VGA_REG
  364. printf("vga: read GR%x = 0x%02x\n", s->gr_index, val);
  365. #endif
  366. break;
  367. case VGA_CRT_IM:
  368. case VGA_CRT_IC:
  369. val = s->cr_index;
  370. break;
  371. case VGA_CRT_DM:
  372. case VGA_CRT_DC:
  373. val = s->cr[s->cr_index];
  374. #ifdef DEBUG_VGA_REG
  375. printf("vga: read CR%x = 0x%02x\n", s->cr_index, val);
  376. #endif
  377. break;
  378. case VGA_IS1_RM:
  379. case VGA_IS1_RC:
  380. /* just toggle to fool polling */
  381. val = s->st01 = s->retrace(s);
  382. s->ar_flip_flop = 0;
  383. break;
  384. default:
  385. val = 0x00;
  386. break;
  387. }
  388. }
  389. trace_vga_std_read_io(addr, val);
  390. return val;
  391. }
  392. void vga_ioport_write(void *opaque, uint32_t addr, uint32_t val)
  393. {
  394. VGACommonState *s = opaque;
  395. int index;
  396. /* check port range access depending on color/monochrome mode */
  397. if (vga_ioport_invalid(s, addr)) {
  398. return;
  399. }
  400. trace_vga_std_write_io(addr, val);
  401. switch(addr) {
  402. case VGA_ATT_W:
  403. if (s->ar_flip_flop == 0) {
  404. val &= 0x3f;
  405. s->ar_index = val;
  406. } else {
  407. index = s->ar_index & 0x1f;
  408. switch(index) {
  409. case VGA_ATC_PALETTE0 ... VGA_ATC_PALETTEF:
  410. s->ar[index] = val & 0x3f;
  411. break;
  412. case VGA_ATC_MODE:
  413. s->ar[index] = val & ~0x10;
  414. break;
  415. case VGA_ATC_OVERSCAN:
  416. s->ar[index] = val;
  417. break;
  418. case VGA_ATC_PLANE_ENABLE:
  419. s->ar[index] = val & ~0xc0;
  420. break;
  421. case VGA_ATC_PEL:
  422. s->ar[index] = val & ~0xf0;
  423. break;
  424. case VGA_ATC_COLOR_PAGE:
  425. s->ar[index] = val & ~0xf0;
  426. break;
  427. default:
  428. break;
  429. }
  430. }
  431. s->ar_flip_flop ^= 1;
  432. break;
  433. case VGA_MIS_W:
  434. s->msr = val & ~0x10;
  435. s->update_retrace_info(s);
  436. break;
  437. case VGA_SEQ_I:
  438. s->sr_index = val & 7;
  439. break;
  440. case VGA_SEQ_D:
  441. #ifdef DEBUG_VGA_REG
  442. printf("vga: write SR%x = 0x%02x\n", s->sr_index, val);
  443. #endif
  444. s->sr[s->sr_index] = val & sr_mask[s->sr_index];
  445. if (s->sr_index == VGA_SEQ_CLOCK_MODE) {
  446. s->update_retrace_info(s);
  447. }
  448. vga_update_memory_access(s);
  449. break;
  450. case VGA_PEL_IR:
  451. s->dac_read_index = val;
  452. s->dac_sub_index = 0;
  453. s->dac_state = 3;
  454. break;
  455. case VGA_PEL_IW:
  456. s->dac_write_index = val;
  457. s->dac_sub_index = 0;
  458. s->dac_state = 0;
  459. break;
  460. case VGA_PEL_D:
  461. s->dac_cache[s->dac_sub_index] = val;
  462. if (++s->dac_sub_index == 3) {
  463. memcpy(&s->palette[s->dac_write_index * 3], s->dac_cache, 3);
  464. s->dac_sub_index = 0;
  465. s->dac_write_index++;
  466. }
  467. break;
  468. case VGA_GFX_I:
  469. s->gr_index = val & 0x0f;
  470. break;
  471. case VGA_GFX_D:
  472. #ifdef DEBUG_VGA_REG
  473. printf("vga: write GR%x = 0x%02x\n", s->gr_index, val);
  474. #endif
  475. s->gr[s->gr_index] = val & gr_mask[s->gr_index];
  476. vbe_update_vgaregs(s);
  477. vga_update_memory_access(s);
  478. break;
  479. case VGA_CRT_IM:
  480. case VGA_CRT_IC:
  481. s->cr_index = val;
  482. break;
  483. case VGA_CRT_DM:
  484. case VGA_CRT_DC:
  485. #ifdef DEBUG_VGA_REG
  486. printf("vga: write CR%x = 0x%02x\n", s->cr_index, val);
  487. #endif
  488. /* handle CR0-7 protection */
  489. if ((s->cr[VGA_CRTC_V_SYNC_END] & VGA_CR11_LOCK_CR0_CR7) &&
  490. s->cr_index <= VGA_CRTC_OVERFLOW) {
  491. /* can always write bit 4 of CR7 */
  492. if (s->cr_index == VGA_CRTC_OVERFLOW) {
  493. s->cr[VGA_CRTC_OVERFLOW] = (s->cr[VGA_CRTC_OVERFLOW] & ~0x10) |
  494. (val & 0x10);
  495. vbe_update_vgaregs(s);
  496. }
  497. return;
  498. }
  499. s->cr[s->cr_index] = val;
  500. vbe_update_vgaregs(s);
  501. switch(s->cr_index) {
  502. case VGA_CRTC_H_TOTAL:
  503. case VGA_CRTC_H_SYNC_START:
  504. case VGA_CRTC_H_SYNC_END:
  505. case VGA_CRTC_V_TOTAL:
  506. case VGA_CRTC_OVERFLOW:
  507. case VGA_CRTC_V_SYNC_END:
  508. case VGA_CRTC_MODE:
  509. s->update_retrace_info(s);
  510. break;
  511. }
  512. break;
  513. case VGA_IS1_RM:
  514. case VGA_IS1_RC:
  515. s->fcr = val & 0x10;
  516. break;
  517. }
  518. }
  519. /*
  520. * Sanity check vbe register writes.
  521. *
  522. * As we don't have a way to signal errors to the guest in the bochs
  523. * dispi interface we'll go adjust the registers to the closest valid
  524. * value.
  525. */
  526. static void vbe_fixup_regs(VGACommonState *s)
  527. {
  528. uint16_t *r = s->vbe_regs;
  529. uint32_t bits, linelength, maxy, offset;
  530. if (!vbe_enabled(s)) {
  531. /* vbe is turned off -- nothing to do */
  532. return;
  533. }
  534. /* check depth */
  535. switch (r[VBE_DISPI_INDEX_BPP]) {
  536. case 4:
  537. case 8:
  538. case 16:
  539. case 24:
  540. case 32:
  541. bits = r[VBE_DISPI_INDEX_BPP];
  542. break;
  543. case 15:
  544. bits = 16;
  545. break;
  546. default:
  547. bits = r[VBE_DISPI_INDEX_BPP] = 8;
  548. break;
  549. }
  550. /* check width */
  551. r[VBE_DISPI_INDEX_XRES] &= ~7u;
  552. if (r[VBE_DISPI_INDEX_XRES] == 0) {
  553. r[VBE_DISPI_INDEX_XRES] = 8;
  554. }
  555. if (r[VBE_DISPI_INDEX_XRES] > VBE_DISPI_MAX_XRES) {
  556. r[VBE_DISPI_INDEX_XRES] = VBE_DISPI_MAX_XRES;
  557. }
  558. r[VBE_DISPI_INDEX_VIRT_WIDTH] &= ~7u;
  559. if (r[VBE_DISPI_INDEX_VIRT_WIDTH] > VBE_DISPI_MAX_XRES) {
  560. r[VBE_DISPI_INDEX_VIRT_WIDTH] = VBE_DISPI_MAX_XRES;
  561. }
  562. if (r[VBE_DISPI_INDEX_VIRT_WIDTH] < r[VBE_DISPI_INDEX_XRES]) {
  563. r[VBE_DISPI_INDEX_VIRT_WIDTH] = r[VBE_DISPI_INDEX_XRES];
  564. }
  565. /* check height */
  566. linelength = r[VBE_DISPI_INDEX_VIRT_WIDTH] * bits / 8;
  567. maxy = s->vbe_size / linelength;
  568. if (r[VBE_DISPI_INDEX_YRES] == 0) {
  569. r[VBE_DISPI_INDEX_YRES] = 1;
  570. }
  571. if (r[VBE_DISPI_INDEX_YRES] > VBE_DISPI_MAX_YRES) {
  572. r[VBE_DISPI_INDEX_YRES] = VBE_DISPI_MAX_YRES;
  573. }
  574. if (r[VBE_DISPI_INDEX_YRES] > maxy) {
  575. r[VBE_DISPI_INDEX_YRES] = maxy;
  576. }
  577. /* check offset */
  578. if (r[VBE_DISPI_INDEX_X_OFFSET] > VBE_DISPI_MAX_XRES) {
  579. r[VBE_DISPI_INDEX_X_OFFSET] = VBE_DISPI_MAX_XRES;
  580. }
  581. if (r[VBE_DISPI_INDEX_Y_OFFSET] > VBE_DISPI_MAX_YRES) {
  582. r[VBE_DISPI_INDEX_Y_OFFSET] = VBE_DISPI_MAX_YRES;
  583. }
  584. offset = r[VBE_DISPI_INDEX_X_OFFSET] * bits / 8;
  585. offset += r[VBE_DISPI_INDEX_Y_OFFSET] * linelength;
  586. if (offset + r[VBE_DISPI_INDEX_YRES] * linelength > s->vbe_size) {
  587. r[VBE_DISPI_INDEX_Y_OFFSET] = 0;
  588. offset = r[VBE_DISPI_INDEX_X_OFFSET] * bits / 8;
  589. if (offset + r[VBE_DISPI_INDEX_YRES] * linelength > s->vbe_size) {
  590. r[VBE_DISPI_INDEX_X_OFFSET] = 0;
  591. offset = 0;
  592. }
  593. }
  594. /* update vga state */
  595. r[VBE_DISPI_INDEX_VIRT_HEIGHT] = maxy;
  596. s->vbe_line_offset = linelength;
  597. s->vbe_start_addr = offset / 4;
  598. }
  599. /* we initialize the VGA graphic mode */
  600. static void vbe_update_vgaregs(VGACommonState *s)
  601. {
  602. int h, shift_control;
  603. if (!vbe_enabled(s)) {
  604. /* vbe is turned off -- nothing to do */
  605. return;
  606. }
  607. /* graphic mode + memory map 1 */
  608. s->gr[VGA_GFX_MISC] = (s->gr[VGA_GFX_MISC] & ~0x0c) | 0x04 |
  609. VGA_GR06_GRAPHICS_MODE;
  610. s->cr[VGA_CRTC_MODE] |= 3; /* no CGA modes */
  611. s->cr[VGA_CRTC_OFFSET] = s->vbe_line_offset >> 3;
  612. /* width */
  613. s->cr[VGA_CRTC_H_DISP] =
  614. (s->vbe_regs[VBE_DISPI_INDEX_XRES] >> 3) - 1;
  615. /* height (only meaningful if < 1024) */
  616. h = s->vbe_regs[VBE_DISPI_INDEX_YRES] - 1;
  617. s->cr[VGA_CRTC_V_DISP_END] = h;
  618. s->cr[VGA_CRTC_OVERFLOW] = (s->cr[VGA_CRTC_OVERFLOW] & ~0x42) |
  619. ((h >> 7) & 0x02) | ((h >> 3) & 0x40);
  620. /* line compare to 1023 */
  621. s->cr[VGA_CRTC_LINE_COMPARE] = 0xff;
  622. s->cr[VGA_CRTC_OVERFLOW] |= 0x10;
  623. s->cr[VGA_CRTC_MAX_SCAN] |= 0x40;
  624. if (s->vbe_regs[VBE_DISPI_INDEX_BPP] == 4) {
  625. shift_control = 0;
  626. s->sr_vbe[VGA_SEQ_CLOCK_MODE] &= ~8; /* no double line */
  627. } else {
  628. shift_control = 2;
  629. /* set chain 4 mode */
  630. s->sr_vbe[VGA_SEQ_MEMORY_MODE] |= VGA_SR04_CHN_4M;
  631. /* activate all planes */
  632. s->sr_vbe[VGA_SEQ_PLANE_WRITE] |= VGA_SR02_ALL_PLANES;
  633. }
  634. s->gr[VGA_GFX_MODE] = (s->gr[VGA_GFX_MODE] & ~0x60) |
  635. (shift_control << 5);
  636. s->cr[VGA_CRTC_MAX_SCAN] &= ~0x9f; /* no double scan */
  637. }
  638. static uint32_t vbe_ioport_read_index(void *opaque, uint32_t addr)
  639. {
  640. VGACommonState *s = opaque;
  641. return s->vbe_index;
  642. }
  643. uint32_t vbe_ioport_read_data(void *opaque, uint32_t addr)
  644. {
  645. VGACommonState *s = opaque;
  646. uint32_t val;
  647. if (s->vbe_index < VBE_DISPI_INDEX_NB) {
  648. if (s->vbe_regs[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_GETCAPS) {
  649. switch(s->vbe_index) {
  650. /* XXX: do not hardcode ? */
  651. case VBE_DISPI_INDEX_XRES:
  652. val = VBE_DISPI_MAX_XRES;
  653. break;
  654. case VBE_DISPI_INDEX_YRES:
  655. val = VBE_DISPI_MAX_YRES;
  656. break;
  657. case VBE_DISPI_INDEX_BPP:
  658. val = VBE_DISPI_MAX_BPP;
  659. break;
  660. default:
  661. val = s->vbe_regs[s->vbe_index];
  662. break;
  663. }
  664. } else {
  665. val = s->vbe_regs[s->vbe_index];
  666. }
  667. } else if (s->vbe_index == VBE_DISPI_INDEX_VIDEO_MEMORY_64K) {
  668. val = s->vbe_size / (64 * KiB);
  669. } else {
  670. val = 0;
  671. }
  672. trace_vga_vbe_read(s->vbe_index, val);
  673. return val;
  674. }
  675. void vbe_ioport_write_index(void *opaque, uint32_t addr, uint32_t val)
  676. {
  677. VGACommonState *s = opaque;
  678. s->vbe_index = val;
  679. }
  680. void vbe_ioport_write_data(void *opaque, uint32_t addr, uint32_t val)
  681. {
  682. VGACommonState *s = opaque;
  683. if (s->vbe_index <= VBE_DISPI_INDEX_NB) {
  684. trace_vga_vbe_write(s->vbe_index, val);
  685. switch(s->vbe_index) {
  686. case VBE_DISPI_INDEX_ID:
  687. if (val == VBE_DISPI_ID0 ||
  688. val == VBE_DISPI_ID1 ||
  689. val == VBE_DISPI_ID2 ||
  690. val == VBE_DISPI_ID3 ||
  691. val == VBE_DISPI_ID4 ||
  692. val == VBE_DISPI_ID5) {
  693. s->vbe_regs[s->vbe_index] = val;
  694. }
  695. break;
  696. case VBE_DISPI_INDEX_XRES:
  697. case VBE_DISPI_INDEX_YRES:
  698. case VBE_DISPI_INDEX_BPP:
  699. case VBE_DISPI_INDEX_VIRT_WIDTH:
  700. case VBE_DISPI_INDEX_X_OFFSET:
  701. case VBE_DISPI_INDEX_Y_OFFSET:
  702. s->vbe_regs[s->vbe_index] = val;
  703. vbe_fixup_regs(s);
  704. vbe_update_vgaregs(s);
  705. break;
  706. case VBE_DISPI_INDEX_BANK:
  707. val &= s->vbe_bank_mask;
  708. s->vbe_regs[s->vbe_index] = val;
  709. s->bank_offset = (val << 16);
  710. vga_update_memory_access(s);
  711. break;
  712. case VBE_DISPI_INDEX_ENABLE:
  713. if ((val & VBE_DISPI_ENABLED) &&
  714. !(s->vbe_regs[VBE_DISPI_INDEX_ENABLE] & VBE_DISPI_ENABLED)) {
  715. s->vbe_regs[VBE_DISPI_INDEX_VIRT_WIDTH] = 0;
  716. s->vbe_regs[VBE_DISPI_INDEX_X_OFFSET] = 0;
  717. s->vbe_regs[VBE_DISPI_INDEX_Y_OFFSET] = 0;
  718. s->vbe_regs[VBE_DISPI_INDEX_ENABLE] |= VBE_DISPI_ENABLED;
  719. vbe_fixup_regs(s);
  720. vbe_update_vgaregs(s);
  721. /* clear the screen */
  722. if (!(val & VBE_DISPI_NOCLEARMEM)) {
  723. memset(s->vram_ptr, 0,
  724. s->vbe_regs[VBE_DISPI_INDEX_YRES] * s->vbe_line_offset);
  725. }
  726. } else {
  727. s->bank_offset = 0;
  728. }
  729. s->dac_8bit = (val & VBE_DISPI_8BIT_DAC) > 0;
  730. s->vbe_regs[s->vbe_index] = val;
  731. vga_update_memory_access(s);
  732. break;
  733. default:
  734. break;
  735. }
  736. }
  737. }
  738. /* called for accesses between 0xa0000 and 0xc0000 */
  739. uint32_t vga_mem_readb(VGACommonState *s, hwaddr addr)
  740. {
  741. int memory_map_mode, plane;
  742. uint32_t ret;
  743. /* convert to VGA memory offset */
  744. memory_map_mode = (s->gr[VGA_GFX_MISC] >> 2) & 3;
  745. addr &= 0x1ffff;
  746. switch(memory_map_mode) {
  747. case 0:
  748. break;
  749. case 1:
  750. if (addr >= 0x10000)
  751. return 0xff;
  752. addr += s->bank_offset;
  753. break;
  754. case 2:
  755. addr -= 0x10000;
  756. if (addr >= 0x8000)
  757. return 0xff;
  758. break;
  759. default:
  760. case 3:
  761. addr -= 0x18000;
  762. if (addr >= 0x8000)
  763. return 0xff;
  764. break;
  765. }
  766. if (sr(s, VGA_SEQ_MEMORY_MODE) & VGA_SR04_CHN_4M) {
  767. /* chain 4 mode : simplest access */
  768. assert(addr < s->vram_size);
  769. ret = s->vram_ptr[addr];
  770. } else if (s->gr[VGA_GFX_MODE] & 0x10) {
  771. /* odd/even mode (aka text mode mapping) */
  772. plane = (s->gr[VGA_GFX_PLANE_READ] & 2) | (addr & 1);
  773. addr = ((addr & ~1) << 1) | plane;
  774. if (addr >= s->vram_size) {
  775. return 0xff;
  776. }
  777. ret = s->vram_ptr[addr];
  778. } else {
  779. /* standard VGA latched access */
  780. if (addr * sizeof(uint32_t) >= s->vram_size) {
  781. return 0xff;
  782. }
  783. s->latch = ((uint32_t *)s->vram_ptr)[addr];
  784. if (!(s->gr[VGA_GFX_MODE] & 0x08)) {
  785. /* read mode 0 */
  786. plane = s->gr[VGA_GFX_PLANE_READ];
  787. ret = GET_PLANE(s->latch, plane);
  788. } else {
  789. /* read mode 1 */
  790. ret = (s->latch ^ mask16[s->gr[VGA_GFX_COMPARE_VALUE]]) &
  791. mask16[s->gr[VGA_GFX_COMPARE_MASK]];
  792. ret |= ret >> 16;
  793. ret |= ret >> 8;
  794. ret = (~ret) & 0xff;
  795. }
  796. }
  797. return ret;
  798. }
  799. /* called for accesses between 0xa0000 and 0xc0000 */
  800. void vga_mem_writeb(VGACommonState *s, hwaddr addr, uint32_t val)
  801. {
  802. int memory_map_mode, plane, write_mode, b, func_select, mask;
  803. uint32_t write_mask, bit_mask, set_mask;
  804. #ifdef DEBUG_VGA_MEM
  805. printf("vga: [0x" HWADDR_FMT_plx "] = 0x%02x\n", addr, val);
  806. #endif
  807. /* convert to VGA memory offset */
  808. memory_map_mode = (s->gr[VGA_GFX_MISC] >> 2) & 3;
  809. addr &= 0x1ffff;
  810. switch(memory_map_mode) {
  811. case 0:
  812. break;
  813. case 1:
  814. if (addr >= 0x10000)
  815. return;
  816. addr += s->bank_offset;
  817. break;
  818. case 2:
  819. addr -= 0x10000;
  820. if (addr >= 0x8000)
  821. return;
  822. break;
  823. default:
  824. case 3:
  825. addr -= 0x18000;
  826. if (addr >= 0x8000)
  827. return;
  828. break;
  829. }
  830. if (sr(s, VGA_SEQ_MEMORY_MODE) & VGA_SR04_CHN_4M) {
  831. /* chain 4 mode : simplest access */
  832. plane = addr & 3;
  833. mask = (1 << plane);
  834. if (sr(s, VGA_SEQ_PLANE_WRITE) & mask) {
  835. assert(addr < s->vram_size);
  836. s->vram_ptr[addr] = val;
  837. #ifdef DEBUG_VGA_MEM
  838. printf("vga: chain4: [0x" HWADDR_FMT_plx "]\n", addr);
  839. #endif
  840. s->plane_updated |= mask; /* only used to detect font change */
  841. memory_region_set_dirty(&s->vram, addr, 1);
  842. }
  843. } else if (s->gr[VGA_GFX_MODE] & 0x10) {
  844. /* odd/even mode (aka text mode mapping) */
  845. plane = (s->gr[VGA_GFX_PLANE_READ] & 2) | (addr & 1);
  846. mask = (1 << plane);
  847. if (sr(s, VGA_SEQ_PLANE_WRITE) & mask) {
  848. addr = ((addr & ~1) << 1) | plane;
  849. if (addr >= s->vram_size) {
  850. return;
  851. }
  852. s->vram_ptr[addr] = val;
  853. #ifdef DEBUG_VGA_MEM
  854. printf("vga: odd/even: [0x" HWADDR_FMT_plx "]\n", addr);
  855. #endif
  856. s->plane_updated |= mask; /* only used to detect font change */
  857. memory_region_set_dirty(&s->vram, addr, 1);
  858. }
  859. } else {
  860. /* standard VGA latched access */
  861. write_mode = s->gr[VGA_GFX_MODE] & 3;
  862. switch(write_mode) {
  863. default:
  864. case 0:
  865. /* rotate */
  866. b = s->gr[VGA_GFX_DATA_ROTATE] & 7;
  867. val = ((val >> b) | (val << (8 - b))) & 0xff;
  868. val |= val << 8;
  869. val |= val << 16;
  870. /* apply set/reset mask */
  871. set_mask = mask16[s->gr[VGA_GFX_SR_ENABLE]];
  872. val = (val & ~set_mask) |
  873. (mask16[s->gr[VGA_GFX_SR_VALUE]] & set_mask);
  874. bit_mask = s->gr[VGA_GFX_BIT_MASK];
  875. break;
  876. case 1:
  877. val = s->latch;
  878. goto do_write;
  879. case 2:
  880. val = mask16[val & 0x0f];
  881. bit_mask = s->gr[VGA_GFX_BIT_MASK];
  882. break;
  883. case 3:
  884. /* rotate */
  885. b = s->gr[VGA_GFX_DATA_ROTATE] & 7;
  886. val = (val >> b) | (val << (8 - b));
  887. bit_mask = s->gr[VGA_GFX_BIT_MASK] & val;
  888. val = mask16[s->gr[VGA_GFX_SR_VALUE]];
  889. break;
  890. }
  891. /* apply logical operation */
  892. func_select = s->gr[VGA_GFX_DATA_ROTATE] >> 3;
  893. switch(func_select) {
  894. case 0:
  895. default:
  896. /* nothing to do */
  897. break;
  898. case 1:
  899. /* and */
  900. val &= s->latch;
  901. break;
  902. case 2:
  903. /* or */
  904. val |= s->latch;
  905. break;
  906. case 3:
  907. /* xor */
  908. val ^= s->latch;
  909. break;
  910. }
  911. /* apply bit mask */
  912. bit_mask |= bit_mask << 8;
  913. bit_mask |= bit_mask << 16;
  914. val = (val & bit_mask) | (s->latch & ~bit_mask);
  915. do_write:
  916. /* mask data according to sr[2] */
  917. mask = sr(s, VGA_SEQ_PLANE_WRITE);
  918. s->plane_updated |= mask; /* only used to detect font change */
  919. write_mask = mask16[mask];
  920. if (addr * sizeof(uint32_t) >= s->vram_size) {
  921. return;
  922. }
  923. ((uint32_t *)s->vram_ptr)[addr] =
  924. (((uint32_t *)s->vram_ptr)[addr] & ~write_mask) |
  925. (val & write_mask);
  926. #ifdef DEBUG_VGA_MEM
  927. printf("vga: latch: [0x" HWADDR_FMT_plx "] mask=0x%08x val=0x%08x\n",
  928. addr * 4, write_mask, val);
  929. #endif
  930. memory_region_set_dirty(&s->vram, addr << 2, sizeof(uint32_t));
  931. }
  932. }
  933. typedef void vga_draw_line_func(VGACommonState *s1, uint8_t *d,
  934. uint32_t srcaddr, int width);
  935. #include "vga-access.h"
  936. #include "vga-helpers.h"
  937. /* return true if the palette was modified */
  938. static int update_palette16(VGACommonState *s)
  939. {
  940. int full_update, i;
  941. uint32_t v, col, *palette;
  942. full_update = 0;
  943. palette = s->last_palette;
  944. for(i = 0; i < 16; i++) {
  945. v = s->ar[i];
  946. if (s->ar[VGA_ATC_MODE] & 0x80) {
  947. v = ((s->ar[VGA_ATC_COLOR_PAGE] & 0xf) << 4) | (v & 0xf);
  948. } else {
  949. v = ((s->ar[VGA_ATC_COLOR_PAGE] & 0xc) << 4) | (v & 0x3f);
  950. }
  951. v = v * 3;
  952. col = rgb_to_pixel32(c6_to_8(s->palette[v]),
  953. c6_to_8(s->palette[v + 1]),
  954. c6_to_8(s->palette[v + 2]));
  955. if (col != palette[i]) {
  956. full_update = 1;
  957. palette[i] = col;
  958. }
  959. }
  960. return full_update;
  961. }
  962. /* return true if the palette was modified */
  963. static int update_palette256(VGACommonState *s)
  964. {
  965. int full_update, i;
  966. uint32_t v, col, *palette;
  967. full_update = 0;
  968. palette = s->last_palette;
  969. v = 0;
  970. for(i = 0; i < 256; i++) {
  971. if (s->dac_8bit) {
  972. col = rgb_to_pixel32(s->palette[v],
  973. s->palette[v + 1],
  974. s->palette[v + 2]);
  975. } else {
  976. col = rgb_to_pixel32(c6_to_8(s->palette[v]),
  977. c6_to_8(s->palette[v + 1]),
  978. c6_to_8(s->palette[v + 2]));
  979. }
  980. if (col != palette[i]) {
  981. full_update = 1;
  982. palette[i] = col;
  983. }
  984. v += 3;
  985. }
  986. return full_update;
  987. }
  988. static void vga_get_offsets(VGACommonState *s,
  989. uint32_t *pline_offset,
  990. uint32_t *pstart_addr,
  991. uint32_t *pline_compare)
  992. {
  993. uint32_t start_addr, line_offset, line_compare;
  994. if (vbe_enabled(s)) {
  995. line_offset = s->vbe_line_offset;
  996. start_addr = s->vbe_start_addr;
  997. line_compare = 65535;
  998. } else {
  999. /* compute line_offset in bytes */
  1000. line_offset = s->cr[VGA_CRTC_OFFSET];
  1001. line_offset <<= 3;
  1002. /* starting address */
  1003. start_addr = s->cr[VGA_CRTC_START_LO] |
  1004. (s->cr[VGA_CRTC_START_HI] << 8);
  1005. /* line compare */
  1006. line_compare = s->cr[VGA_CRTC_LINE_COMPARE] |
  1007. ((s->cr[VGA_CRTC_OVERFLOW] & 0x10) << 4) |
  1008. ((s->cr[VGA_CRTC_MAX_SCAN] & 0x40) << 3);
  1009. }
  1010. *pline_offset = line_offset;
  1011. *pstart_addr = start_addr;
  1012. *pline_compare = line_compare;
  1013. }
  1014. /* update start_addr and line_offset. Return TRUE if modified */
  1015. static int update_basic_params(VGACommonState *s)
  1016. {
  1017. int full_update;
  1018. uint32_t start_addr, line_offset, line_compare;
  1019. full_update = 0;
  1020. s->get_offsets(s, &line_offset, &start_addr, &line_compare);
  1021. if (line_offset != s->line_offset ||
  1022. start_addr != s->start_addr ||
  1023. line_compare != s->line_compare) {
  1024. s->line_offset = line_offset;
  1025. s->start_addr = start_addr;
  1026. s->line_compare = line_compare;
  1027. full_update = 1;
  1028. }
  1029. return full_update;
  1030. }
  1031. static const uint8_t cursor_glyph[32 * 4] = {
  1032. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1033. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1034. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1035. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1036. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1037. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1038. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1039. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1040. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1041. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1042. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1043. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1044. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1045. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1046. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1047. 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
  1048. };
  1049. static void vga_get_text_resolution(VGACommonState *s, int *pwidth, int *pheight,
  1050. int *pcwidth, int *pcheight)
  1051. {
  1052. int width, cwidth, height, cheight;
  1053. /* total width & height */
  1054. cheight = (s->cr[VGA_CRTC_MAX_SCAN] & 0x1f) + 1;
  1055. cwidth = 8;
  1056. if (!(sr(s, VGA_SEQ_CLOCK_MODE) & VGA_SR01_CHAR_CLK_8DOTS)) {
  1057. cwidth = 9;
  1058. }
  1059. if (sr(s, VGA_SEQ_CLOCK_MODE) & 0x08) {
  1060. cwidth = 16; /* NOTE: no 18 pixel wide */
  1061. }
  1062. width = (s->cr[VGA_CRTC_H_DISP] + 1);
  1063. if (s->cr[VGA_CRTC_V_TOTAL] == 100) {
  1064. /* ugly hack for CGA 160x100x16 - explain me the logic */
  1065. height = 100;
  1066. } else {
  1067. height = s->cr[VGA_CRTC_V_DISP_END] |
  1068. ((s->cr[VGA_CRTC_OVERFLOW] & 0x02) << 7) |
  1069. ((s->cr[VGA_CRTC_OVERFLOW] & 0x40) << 3);
  1070. height = (height + 1) / cheight;
  1071. }
  1072. *pwidth = width;
  1073. *pheight = height;
  1074. *pcwidth = cwidth;
  1075. *pcheight = cheight;
  1076. }
  1077. /*
  1078. * Text mode update
  1079. * Missing:
  1080. * - double scan
  1081. * - double width
  1082. * - underline
  1083. * - flashing
  1084. */
  1085. static void vga_draw_text(VGACommonState *s, int full_update)
  1086. {
  1087. DisplaySurface *surface = qemu_console_surface(s->con);
  1088. int cx, cy, cheight, cw, ch, cattr, height, width, ch_attr;
  1089. int cx_min, cx_max, linesize, x_incr, line, line1;
  1090. uint32_t offset, fgcol, bgcol, v, cursor_offset;
  1091. uint8_t *d1, *d, *src, *dest, *cursor_ptr;
  1092. const uint8_t *font_ptr, *font_base[2];
  1093. int dup9, line_offset;
  1094. uint32_t *palette;
  1095. uint32_t *ch_attr_ptr;
  1096. int64_t now = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
  1097. /* compute font data address (in plane 2) */
  1098. v = sr(s, VGA_SEQ_CHARACTER_MAP);
  1099. offset = (((v >> 4) & 1) | ((v << 1) & 6)) * 8192 * 4 + 2;
  1100. if (offset != s->font_offsets[0]) {
  1101. s->font_offsets[0] = offset;
  1102. full_update = 1;
  1103. }
  1104. font_base[0] = s->vram_ptr + offset;
  1105. offset = (((v >> 5) & 1) | ((v >> 1) & 6)) * 8192 * 4 + 2;
  1106. font_base[1] = s->vram_ptr + offset;
  1107. if (offset != s->font_offsets[1]) {
  1108. s->font_offsets[1] = offset;
  1109. full_update = 1;
  1110. }
  1111. if (s->plane_updated & (1 << 2) || s->has_chain4_alias) {
  1112. /* if the plane 2 was modified since the last display, it
  1113. indicates the font may have been modified */
  1114. s->plane_updated = 0;
  1115. full_update = 1;
  1116. }
  1117. full_update |= update_basic_params(s);
  1118. line_offset = s->line_offset;
  1119. vga_get_text_resolution(s, &width, &height, &cw, &cheight);
  1120. if ((height * width) <= 1) {
  1121. /* better than nothing: exit if transient size is too small */
  1122. return;
  1123. }
  1124. if ((height * width) > CH_ATTR_SIZE) {
  1125. /* better than nothing: exit if transient size is too big */
  1126. return;
  1127. }
  1128. if (width != s->last_width || height != s->last_height ||
  1129. cw != s->last_cw || cheight != s->last_ch || s->last_depth) {
  1130. s->last_scr_width = width * cw;
  1131. s->last_scr_height = height * cheight;
  1132. qemu_console_resize(s->con, s->last_scr_width, s->last_scr_height);
  1133. surface = qemu_console_surface(s->con);
  1134. dpy_text_resize(s->con, width, height);
  1135. s->last_depth = 0;
  1136. s->last_width = width;
  1137. s->last_height = height;
  1138. s->last_ch = cheight;
  1139. s->last_cw = cw;
  1140. full_update = 1;
  1141. }
  1142. full_update |= update_palette16(s);
  1143. palette = s->last_palette;
  1144. x_incr = cw * surface_bytes_per_pixel(surface);
  1145. if (full_update) {
  1146. s->full_update_text = 1;
  1147. }
  1148. if (s->full_update_gfx) {
  1149. s->full_update_gfx = 0;
  1150. full_update |= 1;
  1151. }
  1152. cursor_offset = ((s->cr[VGA_CRTC_CURSOR_HI] << 8) |
  1153. s->cr[VGA_CRTC_CURSOR_LO]) - s->start_addr;
  1154. if (cursor_offset != s->cursor_offset ||
  1155. s->cr[VGA_CRTC_CURSOR_START] != s->cursor_start ||
  1156. s->cr[VGA_CRTC_CURSOR_END] != s->cursor_end) {
  1157. /* if the cursor position changed, we update the old and new
  1158. chars */
  1159. if (s->cursor_offset < CH_ATTR_SIZE)
  1160. s->last_ch_attr[s->cursor_offset] = -1;
  1161. if (cursor_offset < CH_ATTR_SIZE)
  1162. s->last_ch_attr[cursor_offset] = -1;
  1163. s->cursor_offset = cursor_offset;
  1164. s->cursor_start = s->cr[VGA_CRTC_CURSOR_START];
  1165. s->cursor_end = s->cr[VGA_CRTC_CURSOR_END];
  1166. }
  1167. cursor_ptr = s->vram_ptr + (s->start_addr + cursor_offset) * 4;
  1168. if (now >= s->cursor_blink_time) {
  1169. s->cursor_blink_time = now + VGA_TEXT_CURSOR_PERIOD_MS / 2;
  1170. s->cursor_visible_phase = !s->cursor_visible_phase;
  1171. }
  1172. dest = surface_data(surface);
  1173. linesize = surface_stride(surface);
  1174. ch_attr_ptr = s->last_ch_attr;
  1175. line = 0;
  1176. offset = s->start_addr * 4;
  1177. for(cy = 0; cy < height; cy++) {
  1178. d1 = dest;
  1179. src = s->vram_ptr + offset;
  1180. cx_min = width;
  1181. cx_max = -1;
  1182. for(cx = 0; cx < width; cx++) {
  1183. if (src + sizeof(uint16_t) > s->vram_ptr + s->vram_size) {
  1184. break;
  1185. }
  1186. ch_attr = *(uint16_t *)src;
  1187. if (full_update || ch_attr != *ch_attr_ptr || src == cursor_ptr) {
  1188. if (cx < cx_min)
  1189. cx_min = cx;
  1190. if (cx > cx_max)
  1191. cx_max = cx;
  1192. *ch_attr_ptr = ch_attr;
  1193. #if HOST_BIG_ENDIAN
  1194. ch = ch_attr >> 8;
  1195. cattr = ch_attr & 0xff;
  1196. #else
  1197. ch = ch_attr & 0xff;
  1198. cattr = ch_attr >> 8;
  1199. #endif
  1200. font_ptr = font_base[(cattr >> 3) & 1];
  1201. font_ptr += 32 * 4 * ch;
  1202. bgcol = palette[cattr >> 4];
  1203. fgcol = palette[cattr & 0x0f];
  1204. if (cw == 16) {
  1205. vga_draw_glyph16(d1, linesize,
  1206. font_ptr, cheight, fgcol, bgcol);
  1207. } else if (cw != 9) {
  1208. vga_draw_glyph8(d1, linesize,
  1209. font_ptr, cheight, fgcol, bgcol);
  1210. } else {
  1211. dup9 = 0;
  1212. if (ch >= 0xb0 && ch <= 0xdf &&
  1213. (s->ar[VGA_ATC_MODE] & 0x04)) {
  1214. dup9 = 1;
  1215. }
  1216. vga_draw_glyph9(d1, linesize,
  1217. font_ptr, cheight, fgcol, bgcol, dup9);
  1218. }
  1219. if (src == cursor_ptr &&
  1220. !(s->cr[VGA_CRTC_CURSOR_START] & 0x20) &&
  1221. s->cursor_visible_phase) {
  1222. int line_start, line_last, h;
  1223. /* draw the cursor */
  1224. line_start = s->cr[VGA_CRTC_CURSOR_START] & 0x1f;
  1225. line_last = s->cr[VGA_CRTC_CURSOR_END] & 0x1f;
  1226. /* XXX: check that */
  1227. if (line_last > cheight - 1)
  1228. line_last = cheight - 1;
  1229. if (line_last >= line_start && line_start < cheight) {
  1230. h = line_last - line_start + 1;
  1231. d = d1 + linesize * line_start;
  1232. if (cw == 16) {
  1233. vga_draw_glyph16(d, linesize,
  1234. cursor_glyph, h, fgcol, bgcol);
  1235. } else if (cw != 9) {
  1236. vga_draw_glyph8(d, linesize,
  1237. cursor_glyph, h, fgcol, bgcol);
  1238. } else {
  1239. vga_draw_glyph9(d, linesize,
  1240. cursor_glyph, h, fgcol, bgcol, 1);
  1241. }
  1242. }
  1243. }
  1244. }
  1245. d1 += x_incr;
  1246. src += 4;
  1247. ch_attr_ptr++;
  1248. }
  1249. if (cx_max != -1) {
  1250. dpy_gfx_update(s->con, cx_min * cw, cy * cheight,
  1251. (cx_max - cx_min + 1) * cw, cheight);
  1252. }
  1253. dest += linesize * cheight;
  1254. line1 = line + cheight;
  1255. offset += line_offset;
  1256. if (line < s->line_compare && line1 >= s->line_compare) {
  1257. offset = 0;
  1258. }
  1259. line = line1;
  1260. }
  1261. }
  1262. enum {
  1263. VGA_DRAW_LINE2,
  1264. VGA_DRAW_LINE2D2,
  1265. VGA_DRAW_LINE4,
  1266. VGA_DRAW_LINE4D2,
  1267. VGA_DRAW_LINE8D2,
  1268. VGA_DRAW_LINE8,
  1269. VGA_DRAW_LINE15_LE,
  1270. VGA_DRAW_LINE16_LE,
  1271. VGA_DRAW_LINE24_LE,
  1272. VGA_DRAW_LINE32_LE,
  1273. VGA_DRAW_LINE15_BE,
  1274. VGA_DRAW_LINE16_BE,
  1275. VGA_DRAW_LINE24_BE,
  1276. VGA_DRAW_LINE32_BE,
  1277. VGA_DRAW_LINE_NB,
  1278. };
  1279. static vga_draw_line_func * const vga_draw_line_table[VGA_DRAW_LINE_NB] = {
  1280. vga_draw_line2,
  1281. vga_draw_line2d2,
  1282. vga_draw_line4,
  1283. vga_draw_line4d2,
  1284. vga_draw_line8d2,
  1285. vga_draw_line8,
  1286. vga_draw_line15_le,
  1287. vga_draw_line16_le,
  1288. vga_draw_line24_le,
  1289. vga_draw_line32_le,
  1290. vga_draw_line15_be,
  1291. vga_draw_line16_be,
  1292. vga_draw_line24_be,
  1293. vga_draw_line32_be,
  1294. };
  1295. static int vga_get_bpp(VGACommonState *s)
  1296. {
  1297. int ret;
  1298. if (vbe_enabled(s)) {
  1299. ret = s->vbe_regs[VBE_DISPI_INDEX_BPP];
  1300. } else {
  1301. ret = 0;
  1302. }
  1303. return ret;
  1304. }
  1305. static void vga_get_resolution(VGACommonState *s, int *pwidth, int *pheight)
  1306. {
  1307. int width, height;
  1308. if (vbe_enabled(s)) {
  1309. width = s->vbe_regs[VBE_DISPI_INDEX_XRES];
  1310. height = s->vbe_regs[VBE_DISPI_INDEX_YRES];
  1311. } else {
  1312. width = (s->cr[VGA_CRTC_H_DISP] + 1) * 8;
  1313. height = s->cr[VGA_CRTC_V_DISP_END] |
  1314. ((s->cr[VGA_CRTC_OVERFLOW] & 0x02) << 7) |
  1315. ((s->cr[VGA_CRTC_OVERFLOW] & 0x40) << 3);
  1316. height = (height + 1);
  1317. }
  1318. *pwidth = width;
  1319. *pheight = height;
  1320. }
  1321. void vga_invalidate_scanlines(VGACommonState *s, int y1, int y2)
  1322. {
  1323. int y;
  1324. if (y1 >= VGA_MAX_HEIGHT)
  1325. return;
  1326. if (y2 >= VGA_MAX_HEIGHT)
  1327. y2 = VGA_MAX_HEIGHT;
  1328. for(y = y1; y < y2; y++) {
  1329. s->invalidated_y_table[y >> 5] |= 1 << (y & 0x1f);
  1330. }
  1331. }
  1332. static bool vga_scanline_invalidated(VGACommonState *s, int y)
  1333. {
  1334. if (y >= VGA_MAX_HEIGHT) {
  1335. return false;
  1336. }
  1337. return s->invalidated_y_table[y >> 5] & (1 << (y & 0x1f));
  1338. }
  1339. void vga_dirty_log_start(VGACommonState *s)
  1340. {
  1341. memory_region_set_log(&s->vram, true, DIRTY_MEMORY_VGA);
  1342. }
  1343. void vga_dirty_log_stop(VGACommonState *s)
  1344. {
  1345. memory_region_set_log(&s->vram, false, DIRTY_MEMORY_VGA);
  1346. }
  1347. /*
  1348. * graphic modes
  1349. */
  1350. static void vga_draw_graphic(VGACommonState *s, int full_update)
  1351. {
  1352. DisplaySurface *surface = qemu_console_surface(s->con);
  1353. int y1, y, update, linesize, y_start, double_scan, mask, depth;
  1354. int width, height, shift_control, bwidth, bits;
  1355. ram_addr_t page0, page1, region_start, region_end;
  1356. DirtyBitmapSnapshot *snap = NULL;
  1357. int disp_width, multi_scan, multi_run;
  1358. uint8_t *d;
  1359. uint32_t v, addr1, addr;
  1360. vga_draw_line_func *vga_draw_line = NULL;
  1361. bool share_surface, force_shadow = false;
  1362. pixman_format_code_t format;
  1363. #if HOST_BIG_ENDIAN
  1364. bool byteswap = !s->big_endian_fb;
  1365. #else
  1366. bool byteswap = s->big_endian_fb;
  1367. #endif
  1368. full_update |= update_basic_params(s);
  1369. s->get_resolution(s, &width, &height);
  1370. disp_width = width;
  1371. depth = s->get_bpp(s);
  1372. region_start = (s->start_addr * 4);
  1373. region_end = region_start + (ram_addr_t)s->line_offset * height;
  1374. region_end += width * depth / 8; /* scanline length */
  1375. region_end -= s->line_offset;
  1376. if (region_end > s->vbe_size || depth == 0 || depth == 15) {
  1377. /*
  1378. * We land here on:
  1379. * - wraps around (can happen with cirrus vbe modes)
  1380. * - depth == 0 (256 color palette video mode)
  1381. * - depth == 15
  1382. *
  1383. * Take the safe and slow route:
  1384. * - create a dirty bitmap snapshot for all vga memory.
  1385. * - force shadowing (so all vga memory access goes
  1386. * through vga_read_*() helpers).
  1387. *
  1388. * Given this affects only vga features which are pretty much
  1389. * unused by modern guests there should be no performance
  1390. * impact.
  1391. */
  1392. region_start = 0;
  1393. region_end = s->vbe_size;
  1394. force_shadow = true;
  1395. }
  1396. /* bits 5-6: 0 = 16-color mode, 1 = 4-color mode, 2 = 256-color mode. */
  1397. shift_control = (s->gr[VGA_GFX_MODE] >> 5) & 3;
  1398. double_scan = (s->cr[VGA_CRTC_MAX_SCAN] >> 7);
  1399. if (s->cr[VGA_CRTC_MODE] & 1) {
  1400. multi_scan = (((s->cr[VGA_CRTC_MAX_SCAN] & 0x1f) + 1) << double_scan)
  1401. - 1;
  1402. } else {
  1403. /* in CGA modes, multi_scan is ignored */
  1404. /* XXX: is it correct ? */
  1405. multi_scan = double_scan;
  1406. }
  1407. multi_run = multi_scan;
  1408. if (shift_control != s->shift_control ||
  1409. double_scan != s->double_scan) {
  1410. full_update = 1;
  1411. s->shift_control = shift_control;
  1412. s->double_scan = double_scan;
  1413. }
  1414. if (shift_control == 0) {
  1415. if (sr(s, VGA_SEQ_CLOCK_MODE) & 8) {
  1416. disp_width <<= 1;
  1417. }
  1418. } else if (shift_control == 1) {
  1419. if (sr(s, VGA_SEQ_CLOCK_MODE) & 8) {
  1420. disp_width <<= 1;
  1421. }
  1422. }
  1423. /*
  1424. * Check whether we can share the surface with the backend
  1425. * or whether we need a shadow surface. We share native
  1426. * endian surfaces for 15bpp and above and byteswapped
  1427. * surfaces for 24bpp and above.
  1428. */
  1429. format = qemu_default_pixman_format(depth, !byteswap);
  1430. if (format) {
  1431. share_surface = dpy_gfx_check_format(s->con, format)
  1432. && !s->force_shadow && !force_shadow;
  1433. } else {
  1434. share_surface = false;
  1435. }
  1436. if (s->line_offset != s->last_line_offset ||
  1437. disp_width != s->last_width ||
  1438. height != s->last_height ||
  1439. s->last_depth != depth ||
  1440. s->last_byteswap != byteswap ||
  1441. share_surface != is_buffer_shared(surface)) {
  1442. /* display parameters changed -> need new display surface */
  1443. s->last_scr_width = disp_width;
  1444. s->last_scr_height = height;
  1445. s->last_width = disp_width;
  1446. s->last_height = height;
  1447. s->last_line_offset = s->line_offset;
  1448. s->last_depth = depth;
  1449. s->last_byteswap = byteswap;
  1450. full_update = 1;
  1451. }
  1452. if (surface_data(surface) != s->vram_ptr + (s->start_addr * 4)
  1453. && is_buffer_shared(surface)) {
  1454. /* base address changed (page flip) -> shared display surfaces
  1455. * must be updated with the new base address */
  1456. full_update = 1;
  1457. }
  1458. if (full_update) {
  1459. if (share_surface) {
  1460. surface = qemu_create_displaysurface_from(disp_width,
  1461. height, format, s->line_offset,
  1462. s->vram_ptr + (s->start_addr * 4));
  1463. dpy_gfx_replace_surface(s->con, surface);
  1464. } else {
  1465. qemu_console_resize(s->con, disp_width, height);
  1466. surface = qemu_console_surface(s->con);
  1467. }
  1468. }
  1469. if (shift_control == 0) {
  1470. full_update |= update_palette16(s);
  1471. if (sr(s, VGA_SEQ_CLOCK_MODE) & 8) {
  1472. v = VGA_DRAW_LINE4D2;
  1473. } else {
  1474. v = VGA_DRAW_LINE4;
  1475. }
  1476. bits = 4;
  1477. } else if (shift_control == 1) {
  1478. full_update |= update_palette16(s);
  1479. if (sr(s, VGA_SEQ_CLOCK_MODE) & 8) {
  1480. v = VGA_DRAW_LINE2D2;
  1481. } else {
  1482. v = VGA_DRAW_LINE2;
  1483. }
  1484. bits = 4;
  1485. } else {
  1486. switch(s->get_bpp(s)) {
  1487. default:
  1488. case 0:
  1489. full_update |= update_palette256(s);
  1490. v = VGA_DRAW_LINE8D2;
  1491. bits = 4;
  1492. break;
  1493. case 8:
  1494. full_update |= update_palette256(s);
  1495. v = VGA_DRAW_LINE8;
  1496. bits = 8;
  1497. break;
  1498. case 15:
  1499. v = s->big_endian_fb ? VGA_DRAW_LINE15_BE : VGA_DRAW_LINE15_LE;
  1500. bits = 16;
  1501. break;
  1502. case 16:
  1503. v = s->big_endian_fb ? VGA_DRAW_LINE16_BE : VGA_DRAW_LINE16_LE;
  1504. bits = 16;
  1505. break;
  1506. case 24:
  1507. v = s->big_endian_fb ? VGA_DRAW_LINE24_BE : VGA_DRAW_LINE24_LE;
  1508. bits = 24;
  1509. break;
  1510. case 32:
  1511. v = s->big_endian_fb ? VGA_DRAW_LINE32_BE : VGA_DRAW_LINE32_LE;
  1512. bits = 32;
  1513. break;
  1514. }
  1515. }
  1516. vga_draw_line = vga_draw_line_table[v];
  1517. if (!is_buffer_shared(surface) && s->cursor_invalidate) {
  1518. s->cursor_invalidate(s);
  1519. }
  1520. #if 0
  1521. printf("w=%d h=%d v=%d line_offset=%d cr[0x09]=0x%02x cr[0x17]=0x%02x linecmp=%d sr[0x01]=0x%02x\n",
  1522. width, height, v, line_offset, s->cr[9], s->cr[VGA_CRTC_MODE],
  1523. s->line_compare, sr(s, VGA_SEQ_CLOCK_MODE));
  1524. #endif
  1525. addr1 = (s->start_addr * 4);
  1526. bwidth = DIV_ROUND_UP(width * bits, 8);
  1527. y_start = -1;
  1528. d = surface_data(surface);
  1529. linesize = surface_stride(surface);
  1530. y1 = 0;
  1531. if (!full_update) {
  1532. if (s->line_compare < height) {
  1533. /* split screen mode */
  1534. region_start = 0;
  1535. }
  1536. snap = memory_region_snapshot_and_clear_dirty(&s->vram, region_start,
  1537. region_end - region_start,
  1538. DIRTY_MEMORY_VGA);
  1539. }
  1540. for(y = 0; y < height; y++) {
  1541. addr = addr1;
  1542. if (!(s->cr[VGA_CRTC_MODE] & 1)) {
  1543. int shift;
  1544. /* CGA compatibility handling */
  1545. shift = 14 + ((s->cr[VGA_CRTC_MODE] >> 6) & 1);
  1546. addr = (addr & ~(1 << shift)) | ((y1 & 1) << shift);
  1547. }
  1548. if (!(s->cr[VGA_CRTC_MODE] & 2)) {
  1549. addr = (addr & ~0x8000) | ((y1 & 2) << 14);
  1550. }
  1551. page0 = addr & s->vbe_size_mask;
  1552. page1 = (addr + bwidth - 1) & s->vbe_size_mask;
  1553. if (full_update) {
  1554. update = 1;
  1555. } else if (page1 < page0) {
  1556. /* scanline wraps from end of video memory to the start */
  1557. assert(force_shadow);
  1558. update = memory_region_snapshot_get_dirty(&s->vram, snap,
  1559. page0, s->vbe_size - page0);
  1560. update |= memory_region_snapshot_get_dirty(&s->vram, snap,
  1561. 0, page1);
  1562. } else {
  1563. update = memory_region_snapshot_get_dirty(&s->vram, snap,
  1564. page0, page1 - page0);
  1565. }
  1566. /* explicit invalidation for the hardware cursor (cirrus only) */
  1567. update |= vga_scanline_invalidated(s, y);
  1568. if (update) {
  1569. if (y_start < 0)
  1570. y_start = y;
  1571. if (!(is_buffer_shared(surface))) {
  1572. vga_draw_line(s, d, addr, width);
  1573. if (s->cursor_draw_line)
  1574. s->cursor_draw_line(s, d, y);
  1575. }
  1576. } else {
  1577. if (y_start >= 0) {
  1578. /* flush to display */
  1579. dpy_gfx_update(s->con, 0, y_start,
  1580. disp_width, y - y_start);
  1581. y_start = -1;
  1582. }
  1583. }
  1584. if (!multi_run) {
  1585. mask = (s->cr[VGA_CRTC_MODE] & 3) ^ 3;
  1586. if ((y1 & mask) == mask)
  1587. addr1 += s->line_offset;
  1588. y1++;
  1589. multi_run = multi_scan;
  1590. } else {
  1591. multi_run--;
  1592. }
  1593. /* line compare acts on the displayed lines */
  1594. if (y == s->line_compare)
  1595. addr1 = 0;
  1596. d += linesize;
  1597. }
  1598. if (y_start >= 0) {
  1599. /* flush to display */
  1600. dpy_gfx_update(s->con, 0, y_start,
  1601. disp_width, y - y_start);
  1602. }
  1603. g_free(snap);
  1604. memset(s->invalidated_y_table, 0, sizeof(s->invalidated_y_table));
  1605. }
  1606. static void vga_draw_blank(VGACommonState *s, int full_update)
  1607. {
  1608. DisplaySurface *surface = qemu_console_surface(s->con);
  1609. int i, w;
  1610. uint8_t *d;
  1611. if (!full_update)
  1612. return;
  1613. if (s->last_scr_width <= 0 || s->last_scr_height <= 0)
  1614. return;
  1615. w = s->last_scr_width * surface_bytes_per_pixel(surface);
  1616. d = surface_data(surface);
  1617. for(i = 0; i < s->last_scr_height; i++) {
  1618. memset(d, 0, w);
  1619. d += surface_stride(surface);
  1620. }
  1621. dpy_gfx_update_full(s->con);
  1622. }
  1623. #define GMODE_TEXT 0
  1624. #define GMODE_GRAPH 1
  1625. #define GMODE_BLANK 2
  1626. static void vga_update_display(void *opaque)
  1627. {
  1628. VGACommonState *s = opaque;
  1629. DisplaySurface *surface = qemu_console_surface(s->con);
  1630. int full_update, graphic_mode;
  1631. qemu_flush_coalesced_mmio_buffer();
  1632. if (surface_bits_per_pixel(surface) == 0) {
  1633. /* nothing to do */
  1634. } else {
  1635. full_update = 0;
  1636. if (!(s->ar_index & 0x20)) {
  1637. graphic_mode = GMODE_BLANK;
  1638. } else {
  1639. graphic_mode = s->gr[VGA_GFX_MISC] & VGA_GR06_GRAPHICS_MODE;
  1640. }
  1641. if (graphic_mode != s->graphic_mode) {
  1642. s->graphic_mode = graphic_mode;
  1643. s->cursor_blink_time = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL);
  1644. full_update = 1;
  1645. }
  1646. switch(graphic_mode) {
  1647. case GMODE_TEXT:
  1648. vga_draw_text(s, full_update);
  1649. break;
  1650. case GMODE_GRAPH:
  1651. vga_draw_graphic(s, full_update);
  1652. break;
  1653. case GMODE_BLANK:
  1654. default:
  1655. vga_draw_blank(s, full_update);
  1656. break;
  1657. }
  1658. }
  1659. }
  1660. /* force a full display refresh */
  1661. static void vga_invalidate_display(void *opaque)
  1662. {
  1663. VGACommonState *s = opaque;
  1664. s->last_width = -1;
  1665. s->last_height = -1;
  1666. }
  1667. void vga_common_reset(VGACommonState *s)
  1668. {
  1669. s->sr_index = 0;
  1670. memset(s->sr, '\0', sizeof(s->sr));
  1671. memset(s->sr_vbe, '\0', sizeof(s->sr_vbe));
  1672. s->gr_index = 0;
  1673. memset(s->gr, '\0', sizeof(s->gr));
  1674. s->ar_index = 0;
  1675. memset(s->ar, '\0', sizeof(s->ar));
  1676. s->ar_flip_flop = 0;
  1677. s->cr_index = 0;
  1678. memset(s->cr, '\0', sizeof(s->cr));
  1679. s->msr = 0;
  1680. s->fcr = 0;
  1681. s->st00 = 0;
  1682. s->st01 = 0;
  1683. s->dac_state = 0;
  1684. s->dac_sub_index = 0;
  1685. s->dac_read_index = 0;
  1686. s->dac_write_index = 0;
  1687. memset(s->dac_cache, '\0', sizeof(s->dac_cache));
  1688. s->dac_8bit = 0;
  1689. memset(s->palette, '\0', sizeof(s->palette));
  1690. s->bank_offset = 0;
  1691. s->vbe_index = 0;
  1692. memset(s->vbe_regs, '\0', sizeof(s->vbe_regs));
  1693. s->vbe_regs[VBE_DISPI_INDEX_ID] = VBE_DISPI_ID5;
  1694. s->vbe_start_addr = 0;
  1695. s->vbe_line_offset = 0;
  1696. s->vbe_bank_mask = (s->vram_size >> 16) - 1;
  1697. memset(s->font_offsets, '\0', sizeof(s->font_offsets));
  1698. s->graphic_mode = -1; /* force full update */
  1699. s->shift_control = 0;
  1700. s->double_scan = 0;
  1701. s->line_offset = 0;
  1702. s->line_compare = 0;
  1703. s->start_addr = 0;
  1704. s->plane_updated = 0;
  1705. s->last_cw = 0;
  1706. s->last_ch = 0;
  1707. s->last_width = 0;
  1708. s->last_height = 0;
  1709. s->last_scr_width = 0;
  1710. s->last_scr_height = 0;
  1711. s->cursor_start = 0;
  1712. s->cursor_end = 0;
  1713. s->cursor_offset = 0;
  1714. s->big_endian_fb = s->default_endian_fb;
  1715. memset(s->invalidated_y_table, '\0', sizeof(s->invalidated_y_table));
  1716. memset(s->last_palette, '\0', sizeof(s->last_palette));
  1717. memset(s->last_ch_attr, '\0', sizeof(s->last_ch_attr));
  1718. switch (vga_retrace_method) {
  1719. case VGA_RETRACE_DUMB:
  1720. break;
  1721. case VGA_RETRACE_PRECISE:
  1722. memset(&s->retrace_info, 0, sizeof (s->retrace_info));
  1723. break;
  1724. }
  1725. vga_update_memory_access(s);
  1726. }
  1727. static void vga_reset(void *opaque)
  1728. {
  1729. VGACommonState *s = opaque;
  1730. vga_common_reset(s);
  1731. }
  1732. #define TEXTMODE_X(x) ((x) % width)
  1733. #define TEXTMODE_Y(x) ((x) / width)
  1734. #define VMEM2CHTYPE(v) ((v & 0xff0007ff) | \
  1735. ((v & 0x00000800) << 10) | ((v & 0x00007000) >> 1))
  1736. /* relay text rendering to the display driver
  1737. * instead of doing a full vga_update_display() */
  1738. static void vga_update_text(void *opaque, console_ch_t *chardata)
  1739. {
  1740. VGACommonState *s = opaque;
  1741. int graphic_mode, i, cursor_offset, cursor_visible;
  1742. int cw, cheight, width, height, size, c_min, c_max;
  1743. uint32_t *src;
  1744. console_ch_t *dst, val;
  1745. char msg_buffer[80];
  1746. int full_update = 0;
  1747. qemu_flush_coalesced_mmio_buffer();
  1748. if (!(s->ar_index & 0x20)) {
  1749. graphic_mode = GMODE_BLANK;
  1750. } else {
  1751. graphic_mode = s->gr[VGA_GFX_MISC] & VGA_GR06_GRAPHICS_MODE;
  1752. }
  1753. if (graphic_mode != s->graphic_mode) {
  1754. s->graphic_mode = graphic_mode;
  1755. full_update = 1;
  1756. }
  1757. if (s->last_width == -1) {
  1758. s->last_width = 0;
  1759. full_update = 1;
  1760. }
  1761. switch (graphic_mode) {
  1762. case GMODE_TEXT:
  1763. /* TODO: update palette */
  1764. full_update |= update_basic_params(s);
  1765. /* total width & height */
  1766. cheight = (s->cr[VGA_CRTC_MAX_SCAN] & 0x1f) + 1;
  1767. cw = 8;
  1768. if (!(sr(s, VGA_SEQ_CLOCK_MODE) & VGA_SR01_CHAR_CLK_8DOTS)) {
  1769. cw = 9;
  1770. }
  1771. if (sr(s, VGA_SEQ_CLOCK_MODE) & 0x08) {
  1772. cw = 16; /* NOTE: no 18 pixel wide */
  1773. }
  1774. width = (s->cr[VGA_CRTC_H_DISP] + 1);
  1775. if (s->cr[VGA_CRTC_V_TOTAL] == 100) {
  1776. /* ugly hack for CGA 160x100x16 - explain me the logic */
  1777. height = 100;
  1778. } else {
  1779. height = s->cr[VGA_CRTC_V_DISP_END] |
  1780. ((s->cr[VGA_CRTC_OVERFLOW] & 0x02) << 7) |
  1781. ((s->cr[VGA_CRTC_OVERFLOW] & 0x40) << 3);
  1782. height = (height + 1) / cheight;
  1783. }
  1784. size = (height * width);
  1785. if (size > CH_ATTR_SIZE) {
  1786. if (!full_update)
  1787. return;
  1788. snprintf(msg_buffer, sizeof(msg_buffer), "%i x %i Text mode",
  1789. width, height);
  1790. break;
  1791. }
  1792. if (width != s->last_width || height != s->last_height ||
  1793. cw != s->last_cw || cheight != s->last_ch) {
  1794. s->last_scr_width = width * cw;
  1795. s->last_scr_height = height * cheight;
  1796. qemu_console_resize(s->con, s->last_scr_width, s->last_scr_height);
  1797. dpy_text_resize(s->con, width, height);
  1798. s->last_depth = 0;
  1799. s->last_width = width;
  1800. s->last_height = height;
  1801. s->last_ch = cheight;
  1802. s->last_cw = cw;
  1803. full_update = 1;
  1804. }
  1805. if (full_update) {
  1806. s->full_update_gfx = 1;
  1807. }
  1808. if (s->full_update_text) {
  1809. s->full_update_text = 0;
  1810. full_update |= 1;
  1811. }
  1812. /* Update "hardware" cursor */
  1813. cursor_offset = ((s->cr[VGA_CRTC_CURSOR_HI] << 8) |
  1814. s->cr[VGA_CRTC_CURSOR_LO]) - s->start_addr;
  1815. if (cursor_offset != s->cursor_offset ||
  1816. s->cr[VGA_CRTC_CURSOR_START] != s->cursor_start ||
  1817. s->cr[VGA_CRTC_CURSOR_END] != s->cursor_end || full_update) {
  1818. cursor_visible = !(s->cr[VGA_CRTC_CURSOR_START] & 0x20);
  1819. if (cursor_visible && cursor_offset < size && cursor_offset >= 0)
  1820. dpy_text_cursor(s->con,
  1821. TEXTMODE_X(cursor_offset),
  1822. TEXTMODE_Y(cursor_offset));
  1823. else
  1824. dpy_text_cursor(s->con, -1, -1);
  1825. s->cursor_offset = cursor_offset;
  1826. s->cursor_start = s->cr[VGA_CRTC_CURSOR_START];
  1827. s->cursor_end = s->cr[VGA_CRTC_CURSOR_END];
  1828. }
  1829. src = (uint32_t *) s->vram_ptr + s->start_addr;
  1830. dst = chardata;
  1831. if (full_update) {
  1832. for (i = 0; i < size; src ++, dst ++, i ++)
  1833. console_write_ch(dst, VMEM2CHTYPE(le32_to_cpu(*src)));
  1834. dpy_text_update(s->con, 0, 0, width, height);
  1835. } else {
  1836. c_max = 0;
  1837. for (i = 0; i < size; src ++, dst ++, i ++) {
  1838. console_write_ch(&val, VMEM2CHTYPE(le32_to_cpu(*src)));
  1839. if (*dst != val) {
  1840. *dst = val;
  1841. c_max = i;
  1842. break;
  1843. }
  1844. }
  1845. c_min = i;
  1846. for (; i < size; src ++, dst ++, i ++) {
  1847. console_write_ch(&val, VMEM2CHTYPE(le32_to_cpu(*src)));
  1848. if (*dst != val) {
  1849. *dst = val;
  1850. c_max = i;
  1851. }
  1852. }
  1853. if (c_min <= c_max) {
  1854. i = TEXTMODE_Y(c_min);
  1855. dpy_text_update(s->con, 0, i, width, TEXTMODE_Y(c_max) - i + 1);
  1856. }
  1857. }
  1858. return;
  1859. case GMODE_GRAPH:
  1860. if (!full_update)
  1861. return;
  1862. s->get_resolution(s, &width, &height);
  1863. snprintf(msg_buffer, sizeof(msg_buffer), "%i x %i Graphic mode",
  1864. width, height);
  1865. break;
  1866. case GMODE_BLANK:
  1867. default:
  1868. if (!full_update)
  1869. return;
  1870. snprintf(msg_buffer, sizeof(msg_buffer), "VGA Blank mode");
  1871. break;
  1872. }
  1873. /* Display a message */
  1874. s->last_width = 60;
  1875. s->last_height = height = 3;
  1876. dpy_text_cursor(s->con, -1, -1);
  1877. dpy_text_resize(s->con, s->last_width, height);
  1878. for (dst = chardata, i = 0; i < s->last_width * height; i ++)
  1879. console_write_ch(dst ++, ' ');
  1880. size = strlen(msg_buffer);
  1881. width = (s->last_width - size) / 2;
  1882. dst = chardata + s->last_width + width;
  1883. for (i = 0; i < size; i ++)
  1884. console_write_ch(dst ++, ATTR2CHTYPE(msg_buffer[i], QEMU_COLOR_BLUE,
  1885. QEMU_COLOR_BLACK, 1));
  1886. dpy_text_update(s->con, 0, 0, s->last_width, height);
  1887. }
  1888. static uint64_t vga_mem_read(void *opaque, hwaddr addr,
  1889. unsigned size)
  1890. {
  1891. VGACommonState *s = opaque;
  1892. return vga_mem_readb(s, addr);
  1893. }
  1894. static void vga_mem_write(void *opaque, hwaddr addr,
  1895. uint64_t data, unsigned size)
  1896. {
  1897. VGACommonState *s = opaque;
  1898. vga_mem_writeb(s, addr, data);
  1899. }
  1900. const MemoryRegionOps vga_mem_ops = {
  1901. .read = vga_mem_read,
  1902. .write = vga_mem_write,
  1903. .endianness = DEVICE_LITTLE_ENDIAN,
  1904. .impl = {
  1905. .min_access_size = 1,
  1906. .max_access_size = 1,
  1907. },
  1908. };
  1909. static int vga_common_post_load(void *opaque, int version_id)
  1910. {
  1911. VGACommonState *s = opaque;
  1912. /* force refresh */
  1913. s->graphic_mode = -1;
  1914. vbe_update_vgaregs(s);
  1915. vga_update_memory_access(s);
  1916. return 0;
  1917. }
  1918. static bool vga_endian_state_needed(void *opaque)
  1919. {
  1920. VGACommonState *s = opaque;
  1921. /*
  1922. * Only send the endian state if it's different from the
  1923. * default one, thus ensuring backward compatibility for
  1924. * migration of the common case
  1925. */
  1926. return s->default_endian_fb != s->big_endian_fb;
  1927. }
  1928. static const VMStateDescription vmstate_vga_endian = {
  1929. .name = "vga.endian",
  1930. .version_id = 1,
  1931. .minimum_version_id = 1,
  1932. .needed = vga_endian_state_needed,
  1933. .fields = (VMStateField[]) {
  1934. VMSTATE_BOOL(big_endian_fb, VGACommonState),
  1935. VMSTATE_END_OF_LIST()
  1936. }
  1937. };
  1938. const VMStateDescription vmstate_vga_common = {
  1939. .name = "vga",
  1940. .version_id = 2,
  1941. .minimum_version_id = 2,
  1942. .post_load = vga_common_post_load,
  1943. .fields = (VMStateField[]) {
  1944. VMSTATE_UINT32(latch, VGACommonState),
  1945. VMSTATE_UINT8(sr_index, VGACommonState),
  1946. VMSTATE_PARTIAL_BUFFER(sr, VGACommonState, 8),
  1947. VMSTATE_UINT8(gr_index, VGACommonState),
  1948. VMSTATE_PARTIAL_BUFFER(gr, VGACommonState, 16),
  1949. VMSTATE_UINT8(ar_index, VGACommonState),
  1950. VMSTATE_BUFFER(ar, VGACommonState),
  1951. VMSTATE_INT32(ar_flip_flop, VGACommonState),
  1952. VMSTATE_UINT8(cr_index, VGACommonState),
  1953. VMSTATE_BUFFER(cr, VGACommonState),
  1954. VMSTATE_UINT8(msr, VGACommonState),
  1955. VMSTATE_UINT8(fcr, VGACommonState),
  1956. VMSTATE_UINT8(st00, VGACommonState),
  1957. VMSTATE_UINT8(st01, VGACommonState),
  1958. VMSTATE_UINT8(dac_state, VGACommonState),
  1959. VMSTATE_UINT8(dac_sub_index, VGACommonState),
  1960. VMSTATE_UINT8(dac_read_index, VGACommonState),
  1961. VMSTATE_UINT8(dac_write_index, VGACommonState),
  1962. VMSTATE_BUFFER(dac_cache, VGACommonState),
  1963. VMSTATE_BUFFER(palette, VGACommonState),
  1964. VMSTATE_INT32(bank_offset, VGACommonState),
  1965. VMSTATE_UINT8_EQUAL(is_vbe_vmstate, VGACommonState, NULL),
  1966. VMSTATE_UINT16(vbe_index, VGACommonState),
  1967. VMSTATE_UINT16_ARRAY(vbe_regs, VGACommonState, VBE_DISPI_INDEX_NB),
  1968. VMSTATE_UINT32(vbe_start_addr, VGACommonState),
  1969. VMSTATE_UINT32(vbe_line_offset, VGACommonState),
  1970. VMSTATE_UINT32(vbe_bank_mask, VGACommonState),
  1971. VMSTATE_END_OF_LIST()
  1972. },
  1973. .subsections = (const VMStateDescription*[]) {
  1974. &vmstate_vga_endian,
  1975. NULL
  1976. }
  1977. };
  1978. static const GraphicHwOps vga_ops = {
  1979. .invalidate = vga_invalidate_display,
  1980. .gfx_update = vga_update_display,
  1981. .text_update = vga_update_text,
  1982. };
  1983. static inline uint32_t uint_clamp(uint32_t val, uint32_t vmin, uint32_t vmax)
  1984. {
  1985. if (val < vmin) {
  1986. return vmin;
  1987. }
  1988. if (val > vmax) {
  1989. return vmax;
  1990. }
  1991. return val;
  1992. }
  1993. bool vga_common_init(VGACommonState *s, Object *obj, Error **errp)
  1994. {
  1995. int i, j, v, b;
  1996. Error *local_err = NULL;
  1997. for(i = 0;i < 256; i++) {
  1998. v = 0;
  1999. for(j = 0; j < 8; j++) {
  2000. v |= ((i >> j) & 1) << (j * 4);
  2001. }
  2002. expand4[i] = v;
  2003. v = 0;
  2004. for(j = 0; j < 4; j++) {
  2005. v |= ((i >> (2 * j)) & 3) << (j * 4);
  2006. }
  2007. expand2[i] = v;
  2008. }
  2009. for(i = 0; i < 16; i++) {
  2010. v = 0;
  2011. for(j = 0; j < 4; j++) {
  2012. b = ((i >> j) & 1);
  2013. v |= b << (2 * j);
  2014. v |= b << (2 * j + 1);
  2015. }
  2016. expand4to8[i] = v;
  2017. }
  2018. s->vram_size_mb = uint_clamp(s->vram_size_mb, 1, 512);
  2019. s->vram_size_mb = pow2ceil(s->vram_size_mb);
  2020. s->vram_size = s->vram_size_mb * MiB;
  2021. if (!s->vbe_size) {
  2022. s->vbe_size = s->vram_size;
  2023. }
  2024. s->vbe_size_mask = s->vbe_size - 1;
  2025. s->is_vbe_vmstate = 1;
  2026. if (s->global_vmstate && qemu_ram_block_by_name("vga.vram")) {
  2027. error_setg(errp, "Only one global VGA device can be used at a time");
  2028. return false;
  2029. }
  2030. memory_region_init_ram_nomigrate(&s->vram, obj, "vga.vram", s->vram_size,
  2031. &local_err);
  2032. if (local_err) {
  2033. error_propagate(errp, local_err);
  2034. return false;
  2035. }
  2036. vmstate_register_ram(&s->vram, s->global_vmstate ? NULL : DEVICE(obj));
  2037. xen_register_framebuffer(&s->vram);
  2038. s->vram_ptr = memory_region_get_ram_ptr(&s->vram);
  2039. s->get_bpp = vga_get_bpp;
  2040. s->get_offsets = vga_get_offsets;
  2041. s->get_resolution = vga_get_resolution;
  2042. s->hw_ops = &vga_ops;
  2043. switch (vga_retrace_method) {
  2044. case VGA_RETRACE_DUMB:
  2045. s->retrace = vga_dumb_retrace;
  2046. s->update_retrace_info = vga_dumb_update_retrace_info;
  2047. break;
  2048. case VGA_RETRACE_PRECISE:
  2049. s->retrace = vga_precise_retrace;
  2050. s->update_retrace_info = vga_precise_update_retrace_info;
  2051. break;
  2052. }
  2053. /*
  2054. * Set default fb endian based on target, could probably be turned
  2055. * into a device attribute set by the machine/platform to remove
  2056. * all target endian dependencies from this file.
  2057. */
  2058. #if TARGET_BIG_ENDIAN
  2059. s->default_endian_fb = true;
  2060. #else
  2061. s->default_endian_fb = false;
  2062. #endif
  2063. vga_dirty_log_start(s);
  2064. return true;
  2065. }
  2066. static const MemoryRegionPortio vga_portio_list[] = {
  2067. { 0x04, 2, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3b4 */
  2068. { 0x0a, 1, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3ba */
  2069. { 0x10, 16, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3c0 */
  2070. { 0x24, 2, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3d4 */
  2071. { 0x2a, 1, 1, .read = vga_ioport_read, .write = vga_ioport_write }, /* 3da */
  2072. PORTIO_END_OF_LIST(),
  2073. };
  2074. static const MemoryRegionPortio vbe_portio_list[] = {
  2075. { 0, 1, 2, .read = vbe_ioport_read_index, .write = vbe_ioport_write_index },
  2076. # ifdef TARGET_I386
  2077. { 1, 1, 2, .read = vbe_ioport_read_data, .write = vbe_ioport_write_data },
  2078. # endif
  2079. { 2, 1, 2, .read = vbe_ioport_read_data, .write = vbe_ioport_write_data },
  2080. PORTIO_END_OF_LIST(),
  2081. };
  2082. /* Used by both ISA and PCI */
  2083. MemoryRegion *vga_init_io(VGACommonState *s, Object *obj,
  2084. const MemoryRegionPortio **vga_ports,
  2085. const MemoryRegionPortio **vbe_ports)
  2086. {
  2087. MemoryRegion *vga_mem;
  2088. *vga_ports = vga_portio_list;
  2089. *vbe_ports = vbe_portio_list;
  2090. vga_mem = g_malloc(sizeof(*vga_mem));
  2091. memory_region_init_io(vga_mem, obj, &vga_mem_ops, s,
  2092. "vga-lowmem", 0x20000);
  2093. memory_region_set_flush_coalesced(vga_mem);
  2094. return vga_mem;
  2095. }
  2096. void vga_init(VGACommonState *s, Object *obj, MemoryRegion *address_space,
  2097. MemoryRegion *address_space_io, bool init_vga_ports)
  2098. {
  2099. MemoryRegion *vga_io_memory;
  2100. const MemoryRegionPortio *vga_ports, *vbe_ports;
  2101. qemu_register_reset(vga_reset, s);
  2102. s->bank_offset = 0;
  2103. s->legacy_address_space = address_space;
  2104. vga_io_memory = vga_init_io(s, obj, &vga_ports, &vbe_ports);
  2105. memory_region_add_subregion_overlap(address_space,
  2106. 0x000a0000,
  2107. vga_io_memory,
  2108. 1);
  2109. memory_region_set_coalescing(vga_io_memory);
  2110. if (init_vga_ports) {
  2111. portio_list_init(&s->vga_port_list, obj, vga_ports, s, "vga");
  2112. portio_list_set_flush_coalesced(&s->vga_port_list);
  2113. portio_list_add(&s->vga_port_list, address_space_io, 0x3b0);
  2114. }
  2115. if (vbe_ports) {
  2116. portio_list_init(&s->vbe_port_list, obj, vbe_ports, s, "vbe");
  2117. portio_list_add(&s->vbe_port_list, address_space_io, 0x1ce);
  2118. }
  2119. }