408 vga_mem_wr_handler(uint64_t addr, uint8_t val, void *arg1)  in vga_mem_wr_handler()  argument
465 		val = (val >> sc->vga_gc.gc_rotate) |  in vga_mem_wr_handler()
466 		    (val << (8 - sc->vga_gc.gc_rotate));  in vga_mem_wr_handler()
475 			c0 = (enb_set_reset & 1) ? (c0 & ~mask) : (val & mask);  in vga_mem_wr_handler()
476 			c1 = (enb_set_reset & 2) ? (c1 & ~mask) : (val & mask);  in vga_mem_wr_handler()
477 			c2 = (enb_set_reset & 4) ? (c2 & ~mask) : (val & mask);  in vga_mem_wr_handler()
478 			c3 = (enb_set_reset & 8) ? (c3 & ~mask) : (val & mask);  in vga_mem_wr_handler()
491 			c0 = enb_set_reset & 1 ? c0 & m0 : val & m0;  in vga_mem_wr_handler()
492 			c1 = enb_set_reset & 2 ? c1 & m1 : val & m1;  in vga_mem_wr_handler()
493 			c2 = enb_set_reset & 4 ? c2 & m2 : val & m2;  in vga_mem_wr_handler()
494 			c3 = enb_set_reset & 8 ? c3 & m3 : val & m3;  in vga_mem_wr_handler()
502 			c0 = enb_set_reset & 1 ? c0 | m0 : val | m0;  in vga_mem_wr_handler()
503 			c1 = enb_set_reset & 2 ? c1 | m1 : val | m1;  in vga_mem_wr_handler()
504 			c2 = enb_set_reset & 4 ? c2 | m2 : val | m2;  in vga_mem_wr_handler()
505 			c3 = enb_set_reset & 8 ? c3 | m3 : val | m3;  in vga_mem_wr_handler()
513 			c0 = enb_set_reset & 1 ? c0 ^ m0 : val ^ m0;  in vga_mem_wr_handler()
514 			c1 = enb_set_reset & 2 ? c1 ^ m1 : val ^ m1;  in vga_mem_wr_handler()
515 			c2 = enb_set_reset & 4 ? c2 ^ m2 : val ^ m2;  in vga_mem_wr_handler()
516 			c3 = enb_set_reset & 8 ? c3 ^ m3 : val ^ m3;  in vga_mem_wr_handler()
529 			m0 = (val & 1 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
530 			m1 = (val & 2 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
531 			m2 = (val & 4 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
532 			m3 = (val & 8 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
545 			m0 = (val & 1 ? 0xff : 0x00) | ~mask;  in vga_mem_wr_handler()
546 			m1 = (val & 2 ? 0xff : 0x00) | ~mask;  in vga_mem_wr_handler()
547 			m2 = (val & 4 ? 0xff : 0x00) | ~mask;  in vga_mem_wr_handler()
548 			m3 = (val & 8 ? 0xff : 0x00) | ~mask;  in vga_mem_wr_handler()
556 			m0 = (val & 1 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
557 			m1 = (val & 2 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
558 			m2 = (val & 4 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
559 			m3 = (val & 8 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
567 			m0 = (val & 1 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
568 			m1 = (val & 2 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
569 			m2 = (val & 4 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
570 			m3 = (val & 8 ? 0xff : 0x00) & mask;  in vga_mem_wr_handler()
581 		mask = sc->vga_gc.gc_bit_mask & val;  in vga_mem_wr_handler()
583 		val = (val >> sc->vga_gc.gc_rotate) |  in vga_mem_wr_handler()
584 		    (val << (8 - sc->vga_gc.gc_rotate));  in vga_mem_wr_handler()
667     uint64_t *val, void *arg1, long arg2 __unused)  in vga_mem_handler()  argument
672 			vga_mem_wr_handler(addr, *val, arg1);  in vga_mem_handler()
675 			vga_mem_wr_handler(addr, *val, arg1);  in vga_mem_handler()
676 			vga_mem_wr_handler(addr + 1, *val >> 8, arg1);  in vga_mem_handler()
679 			vga_mem_wr_handler(addr, *val, arg1);  in vga_mem_handler()
680 			vga_mem_wr_handler(addr + 1, *val >> 8, arg1);  in vga_mem_handler()
681 			vga_mem_wr_handler(addr + 2, *val >> 16, arg1);  in vga_mem_handler()
682 			vga_mem_wr_handler(addr + 3, *val >> 24, arg1);  in vga_mem_handler()
685 			vga_mem_wr_handler(addr, *val, arg1);  in vga_mem_handler()
686 			vga_mem_wr_handler(addr + 1, *val >> 8, arg1);  in vga_mem_handler()
687 			vga_mem_wr_handler(addr + 2, *val >> 16, arg1);  in vga_mem_handler()
688 			vga_mem_wr_handler(addr + 3, *val >> 24, arg1);  in vga_mem_handler()
689 			vga_mem_wr_handler(addr + 4, *val >> 32, arg1);  in vga_mem_handler()
690 			vga_mem_wr_handler(addr + 5, *val >> 40, arg1);  in vga_mem_handler()
691 			vga_mem_wr_handler(addr + 6, *val >> 48, arg1);  in vga_mem_handler()
692 			vga_mem_wr_handler(addr + 7, *val >> 56, arg1);  in vga_mem_handler()
698 			*val = vga_mem_rd_handler(addr, arg1);  in vga_mem_handler()
701 			*val = vga_mem_rd_handler(addr, arg1);  in vga_mem_handler()
702 			*val |= vga_mem_rd_handler(addr + 1, arg1) << 8;  in vga_mem_handler()
705 			*val = vga_mem_rd_handler(addr, arg1);  in vga_mem_handler()
706 			*val |= vga_mem_rd_handler(addr + 1, arg1) << 8;  in vga_mem_handler()
707 			*val |= vga_mem_rd_handler(addr + 2, arg1) << 16;  in vga_mem_handler()
708 			*val |= vga_mem_rd_handler(addr + 3, arg1) << 24;  in vga_mem_handler()
711 			*val = vga_mem_rd_handler(addr, arg1);  in vga_mem_handler()
712 			*val |= vga_mem_rd_handler(addr + 1, arg1) << 8;  in vga_mem_handler()
713 			*val |= vga_mem_rd_handler(addr + 2, arg1) << 16;  in vga_mem_handler()
714 			*val |= vga_mem_rd_handler(addr + 3, arg1) << 24;  in vga_mem_handler()
715 			*val |= vga_mem_rd_handler(addr + 4, arg1) << 32;  in vga_mem_handler()
716 			*val |= vga_mem_rd_handler(addr + 5, arg1) << 40;  in vga_mem_handler()
717 			*val |= vga_mem_rd_handler(addr + 6, arg1) << 48;  in vga_mem_handler()
718 			*val |= vga_mem_rd_handler(addr + 7, arg1) << 56;  in vga_mem_handler()
728 		    uint8_t *val, void *arg)  in vga_port_in_handler()  argument
735 		*val = sc->vga_crtc.crtc_index;  in vga_port_in_handler()
741 			*val = sc->vga_crtc.crtc_horiz_total;  in vga_port_in_handler()
744 			*val = sc->vga_crtc.crtc_horiz_disp_end;  in vga_port_in_handler()
747 			*val = sc->vga_crtc.crtc_start_horiz_blank;  in vga_port_in_handler()
750 			*val = sc->vga_crtc.crtc_end_horiz_blank;  in vga_port_in_handler()
753 			*val = sc->vga_crtc.crtc_start_horiz_retrace;  in vga_port_in_handler()
756 			*val = sc->vga_crtc.crtc_end_horiz_retrace;  in vga_port_in_handler()
759 			*val = sc->vga_crtc.crtc_vert_total;  in vga_port_in_handler()
762 			*val = sc->vga_crtc.crtc_overflow;  in vga_port_in_handler()
765 			*val = sc->vga_crtc.crtc_present_row_scan;  in vga_port_in_handler()
768 			*val = sc->vga_crtc.crtc_max_scan_line;  in vga_port_in_handler()
771 			*val = sc->vga_crtc.crtc_cursor_start;  in vga_port_in_handler()
774 			*val = sc->vga_crtc.crtc_cursor_end;  in vga_port_in_handler()
777 			*val = sc->vga_crtc.crtc_start_addr_high;  in vga_port_in_handler()
780 			*val = sc->vga_crtc.crtc_start_addr_low;  in vga_port_in_handler()
783 			*val = sc->vga_crtc.crtc_cursor_loc_high;  in vga_port_in_handler()
786 			*val = sc->vga_crtc.crtc_cursor_loc_low;  in vga_port_in_handler()
789 			*val = sc->vga_crtc.crtc_vert_retrace_start;  in vga_port_in_handler()
792 			*val = sc->vga_crtc.crtc_vert_retrace_end;  in vga_port_in_handler()
795 			*val = sc->vga_crtc.crtc_vert_disp_end;  in vga_port_in_handler()
798 			*val = sc->vga_crtc.crtc_offset;  in vga_port_in_handler()
801 			*val = sc->vga_crtc.crtc_underline_loc;  in vga_port_in_handler()
804 			*val = sc->vga_crtc.crtc_start_vert_blank;  in vga_port_in_handler()
807 			*val = sc->vga_crtc.crtc_end_vert_blank;  in vga_port_in_handler()
810 			*val = sc->vga_crtc.crtc_mode_ctrl;  in vga_port_in_handler()
813 			*val = sc->vga_crtc.crtc_line_compare;  in vga_port_in_handler()
822 		*val = sc->vga_atc.atc_index;  in vga_port_in_handler()
827 			*val = sc->vga_atc.atc_palette[sc->vga_atc.atc_index];  in vga_port_in_handler()
830 			*val = sc->vga_atc.atc_mode;  in vga_port_in_handler()
833 			*val = sc->vga_atc.atc_overscan_color;  in vga_port_in_handler()
836 			*val = sc->vga_atc.atc_color_plane_enb;  in vga_port_in_handler()
839 			*val = sc->vga_atc.atc_horiz_pixel_panning;  in vga_port_in_handler()
842 			*val = sc->vga_atc.atc_color_select;  in vga_port_in_handler()
851 		*val = sc->vga_seq.seq_index;  in vga_port_in_handler()
856 			*val = sc->vga_seq.seq_reset;  in vga_port_in_handler()
859 			*val = sc->vga_seq.seq_clock_mode;  in vga_port_in_handler()
862 			*val = sc->vga_seq.seq_map_mask;  in vga_port_in_handler()
865 			*val = sc->vga_seq.seq_cmap_sel;  in vga_port_in_handler()
868 			*val = sc->vga_seq.seq_mm;  in vga_port_in_handler()
877 		*val = sc->vga_dac.dac_palette[3 * sc->vga_dac.dac_rd_index +  in vga_port_in_handler()
886 		*val = sc->vga_gc.gc_index;  in vga_port_in_handler()
891 			*val = sc->vga_gc.gc_set_reset;  in vga_port_in_handler()
894 			*val = sc->vga_gc.gc_enb_set_reset;  in vga_port_in_handler()
897 			*val = sc->vga_gc.gc_color_compare;  in vga_port_in_handler()
900 			*val = sc->vga_gc.gc_rotate;  in vga_port_in_handler()
903 			*val = sc->vga_gc.gc_read_map_sel;  in vga_port_in_handler()
906 			*val = sc->vga_gc.gc_mode;  in vga_port_in_handler()
909 			*val = sc->vga_gc.gc_misc;  in vga_port_in_handler()
912 			*val = sc->vga_gc.gc_color_dont_care;  in vga_port_in_handler()
915 			*val = sc->vga_gc.gc_bit_mask;  in vga_port_in_handler()
924 		*val = sc->vga_misc;  in vga_port_in_handler()
946 		*val = sc->vga_sts1;  in vga_port_in_handler()
951 		*val = 0;  in vga_port_in_handler()
954 		*val = 0;  in vga_port_in_handler()
967 		     uint8_t val, void *arg)  in vga_port_out_handler()  argument
974 		sc->vga_crtc.crtc_index = val;  in vga_port_out_handler()
980 			sc->vga_crtc.crtc_horiz_total = val;  in vga_port_out_handler()
983 			sc->vga_crtc.crtc_horiz_disp_end = val;  in vga_port_out_handler()
986 			sc->vga_crtc.crtc_start_horiz_blank = val;  in vga_port_out_handler()
989 			sc->vga_crtc.crtc_end_horiz_blank = val;  in vga_port_out_handler()
992 			sc->vga_crtc.crtc_start_horiz_retrace = val;  in vga_port_out_handler()
995 			sc->vga_crtc.crtc_end_horiz_retrace = val;  in vga_port_out_handler()
998 			sc->vga_crtc.crtc_vert_total = val;  in vga_port_out_handler()
1001 			sc->vga_crtc.crtc_overflow = val;  in vga_port_out_handler()
1004 			sc->vga_crtc.crtc_present_row_scan = val;  in vga_port_out_handler()
1007 			sc->vga_crtc.crtc_max_scan_line = val;  in vga_port_out_handler()
1010 			sc->vga_crtc.crtc_cursor_start = val;  in vga_port_out_handler()
1011 			sc->vga_crtc.crtc_cursor_on = (val & CRTC_CS_CO) == 0;  in vga_port_out_handler()
1014 			sc->vga_crtc.crtc_cursor_end = val;  in vga_port_out_handler()
1017 			sc->vga_crtc.crtc_start_addr_high = val;  in vga_port_out_handler()
1019 			sc->vga_crtc.crtc_start_addr |= (val << 8);  in vga_port_out_handler()
1022 			sc->vga_crtc.crtc_start_addr_low = val;  in vga_port_out_handler()
1024 			sc->vga_crtc.crtc_start_addr |= (val & 0xff);  in vga_port_out_handler()
1027 			sc->vga_crtc.crtc_cursor_loc_high = val;  in vga_port_out_handler()
1029 			sc->vga_crtc.crtc_cursor_loc |= (val << 8);  in vga_port_out_handler()
1032 			sc->vga_crtc.crtc_cursor_loc_low = val;  in vga_port_out_handler()
1034 			sc->vga_crtc.crtc_cursor_loc |= (val & 0xff);  in vga_port_out_handler()
1037 			sc->vga_crtc.crtc_vert_retrace_start = val;  in vga_port_out_handler()
1040 			sc->vga_crtc.crtc_vert_retrace_end = val;  in vga_port_out_handler()
1043 			sc->vga_crtc.crtc_vert_disp_end = val;  in vga_port_out_handler()
1046 			sc->vga_crtc.crtc_offset = val;  in vga_port_out_handler()
1049 			sc->vga_crtc.crtc_underline_loc = val;  in vga_port_out_handler()
1052 			sc->vga_crtc.crtc_start_vert_blank = val;  in vga_port_out_handler()
1055 			sc->vga_crtc.crtc_end_vert_blank = val;  in vga_port_out_handler()
1058 			sc->vga_crtc.crtc_mode_ctrl = val;  in vga_port_out_handler()
1061 			sc->vga_crtc.crtc_line_compare = val;  in vga_port_out_handler()
1073 			sc->vga_atc.atc_index = val & ATC_IDX_MASK;  in vga_port_out_handler()
1077 				sc->vga_atc.atc_palette[sc->vga_atc.atc_index] = val & 0x3f;  in vga_port_out_handler()
1080 				sc->vga_atc.atc_mode = val;  in vga_port_out_handler()
1083 				sc->vga_atc.atc_overscan_color = val;  in vga_port_out_handler()
1086 				sc->vga_atc.atc_color_plane_enb = val;  in vga_port_out_handler()
1089 				sc->vga_atc.atc_horiz_pixel_panning = val;  in vga_port_out_handler()
1092 				sc->vga_atc.atc_color_select = val;  in vga_port_out_handler()
1094 					(val & ATC_CS_C45) << 4;  in vga_port_out_handler()
1096 					((val & ATC_CS_C67) >> 2) << 6;  in vga_port_out_handler()
1109 		sc->vga_seq.seq_index = val & 0x1f;  in vga_port_out_handler()
1114 			sc->vga_seq.seq_reset = val;  in vga_port_out_handler()
1117 			sc->vga_seq.seq_clock_mode = val;  in vga_port_out_handler()
1118 			sc->vga_seq.seq_cm_dots = (val & SEQ_CM_89) ? 8 : 9;  in vga_port_out_handler()
1121 			sc->vga_seq.seq_map_mask = val;  in vga_port_out_handler()
1124 			sc->vga_seq.seq_cmap_sel = val;  in vga_port_out_handler()
1126 …sc->vga_seq.seq_cmap_pri_off = ((((val & SEQ_CMS_SA) >> SEQ_CMS_SA_SHIFT) * 2) + ((val & SEQ_CMS_S…  in vga_port_out_handler()
1127 …sc->vga_seq.seq_cmap_sec_off = ((((val & SEQ_CMS_SB) >> SEQ_CMS_SB_SHIFT) * 2) + ((val & SEQ_CMS_S…  in vga_port_out_handler()
1130 			sc->vga_seq.seq_mm = val;  in vga_port_out_handler()
1143 		sc->vga_dac.dac_rd_index = val;  in vga_port_out_handler()
1147 		sc->vga_dac.dac_wr_index = val;  in vga_port_out_handler()
1152 					sc->vga_dac.dac_wr_subindex] = val;  in vga_port_out_handler()
1171 		sc->vga_gc.gc_index = val;  in vga_port_out_handler()
1176 			sc->vga_gc.gc_set_reset = val;  in vga_port_out_handler()
1179 			sc->vga_gc.gc_enb_set_reset = val;  in vga_port_out_handler()
1182 			sc->vga_gc.gc_color_compare = val;  in vga_port_out_handler()
1185 			sc->vga_gc.gc_rotate = val;  in vga_port_out_handler()
1186 			sc->vga_gc.gc_op = (val >> 3) & 0x3;  in vga_port_out_handler()
1189 			sc->vga_gc.gc_read_map_sel = val;  in vga_port_out_handler()
1192 			sc->vga_gc.gc_mode = val;  in vga_port_out_handler()
1193 			sc->vga_gc.gc_mode_c4 = (val & GC_MODE_C4) != 0;  in vga_port_out_handler()
1195 			sc->vga_gc.gc_mode_oe = (val & GC_MODE_OE) != 0;  in vga_port_out_handler()
1196 			sc->vga_gc.gc_mode_rm = (val >> 3) & 0x1;  in vga_port_out_handler()
1197 			sc->vga_gc.gc_mode_wm = val & 0x3;  in vga_port_out_handler()
1203 			sc->vga_gc.gc_misc = val;  in vga_port_out_handler()
1204 			sc->vga_gc.gc_misc_gm = val & GC_MISC_GM;  in vga_port_out_handler()
1205 			sc->vga_gc.gc_misc_mm = (val & GC_MISC_MM) >>  in vga_port_out_handler()
1209 			sc->vga_gc.gc_color_dont_care = val;  in vga_port_out_handler()
1212 			sc->vga_gc.gc_bit_mask = val;  in vga_port_out_handler()
1222 		sc->vga_misc = val;  in vga_port_out_handler()
1231 		printf("XXX vga_port_out_handler() unhandled port 0x%x, val 0x%x\n", port, val);  in vga_port_out_handler()
1242 	uint8_t val;  in vga_port_handler()  local
1250 						    &val, arg);  in vga_port_handler()
1252 				*eax |= val & 0xff;  in vga_port_handler()
1255 			val = *eax & 0xff;  in vga_port_handler()
1257 						     val, arg);  in vga_port_handler()
1264 						    &val, arg);  in vga_port_handler()
1266 				*eax |= val & 0xff;  in vga_port_handler()
1269 						    &val, arg);  in vga_port_handler()
1271 				*eax |= (val & 0xff) << 8;  in vga_port_handler()
1274 			val = *eax & 0xff;  in vga_port_handler()
1276 						     val, arg);  in vga_port_handler()
1277 			val = (*eax >> 8) & 0xff;  in vga_port_handler()
1279 						    val, arg);  in vga_port_handler()