juls0730

vga.rs

Jun 22nd, 2023
1,178
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Rust 3.65 KB | None | 0 0
  1. use crate::libs::io::{inb, outb};
  2.  
  3. static VGA_AC_INDEX: u16 = 0x3C0;
  4. static VGA_AC_WRITE: u16 = 0x3C0;
  5. static VGA_AC_READ: u16 = 0x3C1;
  6. static VGA_MISC_WRITE: u16 = 0x3C2;
  7. static VGA_SEQ_INDEX: u16 = 0x3C4;
  8. static VGA_SEQ_DATA: u16 = 0x3C5;
  9. static VGA_DAC_READ_INDEX: u16 = 0x3C7;
  10. static VGA_DAC_WRITE_INDEX: u16 =   0x3C8;
  11. static VGA_DAC_DATA: u16 = 0x3C9;
  12. static VGA_MISC_READ: u16 = 0x3CC;
  13. static VGA_GC_INDEX: u16 = 0x3CE;
  14. static VGA_GC_DATA: u16 = 0x3CF;
  15. /*          COLOR emulation     MONO emulation */
  16. static VGA_CRTC_INDEX: u16 = 0x3D4;     /* 0x3B4 */
  17. static VGA_CRTC_DATA: u16 = 0x3D5;      /* 0x3B5 */
  18. static VGA_INSTAT_READ: u16 =   0x3DA;
  19.  
  20. static VGA_NUM_SEQ_REGS: u16 = 5;
  21. static VGA_NUM_CRTC_REGS: u16 = 25;
  22. static VGA_NUM_GC_REGS: u16 = 9;
  23. static VGA_NUM_AC_REGS: u16 = 21;
  24. static VGA_NUM_REGS: u16 = 1 + VGA_NUM_SEQ_REGS + VGA_NUM_CRTC_REGS + VGA_NUM_GC_REGS + VGA_NUM_AC_REGS;
  25.  
  26. const VGA_BUFFER: *mut u8 = 0xA0000 as *mut u8;
  27.  
  28. pub fn init_vga() {
  29.     // Set the registers for mode 12h
  30.     let mut registers_720x480x16 = [
  31.         /* MISC */
  32.             0xE7,
  33.         /* SEQ */
  34.             0x03, 0x01, 0x08, 0x00, 0x06,
  35.         /* CRTC */
  36.             0x6B, 0x59, 0x5A, 0x82, 0x60, 0x8D, 0x0B, 0x3E,
  37.             0x00, 0x40, 0x06, 0x07, 0x00, 0x00, 0x00, 0x00,
  38.             0xEA, 0x0C, 0xDF, 0x2D, 0x08, 0xE8, 0x05, 0xE3,
  39.             0xFF,
  40.         /* GC */
  41.             0x00, 0x00, 0x00, 0x00, 0x03, 0x00, 0x05, 0x0F,
  42.             0xFF,
  43.         /* AC */
  44.             0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
  45.             0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
  46.             0x01, 0x00, 0x0F, 0x00, 0x00,
  47.         ];
  48.  
  49.         write_regs(&mut registers_720x480x16);
  50.  
  51.         put_pixel(719, 10, 9);
  52.         put_pixel(100, 10, 9);
  53.         put_pixel(235, 10, 9);
  54.         put_pixel(29, 16, 9);
  55.         put_pixel(12, 49, 9);
  56.         // put_pixel(256, 83, 9);
  57. }
  58.  
  59. fn put_pixel(mut pos_x: usize, pos_y: usize, vga_color: u8) {
  60.     unsafe {
  61.             let width_in_bytes = 720 / 8;
  62.  
  63.             let offset = width_in_bytes * pos_y + pos_x / 8;
  64.             pos_x = (pos_x & 7) * 1;
  65.             let mask: u8 = 0x80 >> pos_x;
  66.             let mut pmask: u8 = 1;
  67.  
  68.             for plane in 0..4 {
  69.                 // set_plane(plane);
  70.                 if pmask & vga_color != 0 {
  71.                     *VGA_BUFFER.offset(offset as isize) = *VGA_BUFFER.offset(offset as isize) | mask;
  72.                 } else {
  73.                     *VGA_BUFFER.offset(offset as isize) = *VGA_BUFFER.offset(offset as isize) & !mask;
  74.                 }
  75.                 pmask <<= 1;
  76.             }
  77.     }
  78. }
  79.  
  80. fn set_plane(plane: u32) {
  81.     let plane = plane & 3;
  82.     let pmask = 1 << plane;
  83.  
  84.     /* set read plane */
  85.     outb(VGA_GC_INDEX, 4);
  86.     outb(VGA_GC_DATA, plane as u8);
  87.    
  88.     /* set write plane */
  89.     outb(VGA_SEQ_INDEX, 2);
  90.     outb(VGA_SEQ_DATA, pmask);
  91. }
  92.  
  93. fn write_regs(mut regs: &mut [u8]) {
  94.     /* write MISCELLANEOUS reg */
  95.     outb(VGA_MISC_WRITE, regs[0]);
  96.     regs = &mut regs[1..];
  97.  
  98.     /* write SEQUENCER regs */
  99.     for i in 0..VGA_NUM_SEQ_REGS {
  100.         outb(VGA_SEQ_INDEX, i as u8);
  101.         outb(VGA_SEQ_DATA, regs[0]);
  102.         regs = &mut regs[1..];
  103.     }
  104.  
  105.     /* unlock CRTC registers */
  106.     outb(VGA_CRTC_INDEX, 0x03);
  107.     outb(VGA_CRTC_DATA, inb(VGA_CRTC_DATA) | 0x80);
  108.     outb(VGA_CRTC_INDEX, 0x11);
  109.     outb(VGA_CRTC_DATA, inb(VGA_CRTC_DATA) & !0x80);
  110.  
  111.     /* make sure they remain unlocked */
  112.     regs[0x03] |= 0x80;
  113.     regs[0x11] &= !0x80;
  114.  
  115.     /* write CRTC regs */
  116.     for i in 0..VGA_NUM_CRTC_REGS {
  117.         outb(VGA_CRTC_INDEX, i as u8);
  118.         outb(VGA_CRTC_DATA, regs[0]);
  119.         regs = &mut regs[1..];
  120.     }
  121.  
  122.     /* write GRAPHICS CONTROLLER regs */
  123.     for i in 0..VGA_NUM_GC_REGS {
  124.         outb(VGA_GC_INDEX, i as u8);
  125.         outb(VGA_GC_DATA, regs[0]);
  126.         regs = &mut regs[1..];
  127.     }
  128.  
  129.     /* write ATTRIBUTE CONTROLLER regs */
  130.     for i in 0..VGA_NUM_AC_REGS {
  131.         // inb(VGA_INSTAT_READ);
  132.         outb(VGA_AC_INDEX, i as u8);
  133.         outb(VGA_AC_WRITE, regs[0]);
  134.         regs = &mut regs[1..];
  135.     }
  136.  
  137.     /* lock 16-color palette and unblank display */
  138.     inb(VGA_INSTAT_READ);
  139.     outb(VGA_AC_INDEX, 0x20);
  140. }
Advertisement
Add Comment
Please, Sign In to add comment