lunaix-os/hal/gfxa/vga/vga_pci.c

   1 #include <lunaix/device.h>
   2 #include <lunaix/mm/mmio.h>
   3 #include <lunaix/mm/valloc.h>
   4 #include <lunaix/spike.h>
   5 #include <lunaix/status.h>
   6
   7 #include <hal/gfxm.h>
   8 #include <hal/pci.h>
   9
  10 #include <klibc/string.h>
  11
  12 #include "vga.h"
  13
  14 extern struct vga_regops vga_default_mmio_ops;
  15
  16 #define FB256K 256 << 10
  17
  18 static u32_t palette[] = {
  19     0x000000, 0x800000, 0x008000, 0x808000, 0x000080, 0x800080, 0x008080,
  20     0xc0c0c0, 0x808080, 0xff0000, 0x00ff00, 0xffff00, 0x0000ff, 0xff00ff,
  21     0x00ffff, 0xffffff, 0x000000, 0x00005f, 0x000087, 0x0000af, 0x0000d7,
  22     0x0000ff, 0x005f00, 0x005f5f, 0x005f87, 0x005faf, 0x005fd7, 0x005fff,
  23     0x008700, 0x00875f, 0x008787, 0x0087af, 0x0087d7, 0x0087ff, 0x00af00,
  24     0x00af5f, 0x00af87, 0x00afaf, 0x00afd7, 0x00afff, 0x00d700, 0x00d75f,
  25     0x00d787, 0x00d7af, 0x00d7d7, 0x00d7ff, 0x00ff00, 0x00ff5f, 0x00ff87,
  26     0x00ffaf, 0x00ffd7, 0x00ffff, 0x5f0000, 0x5f005f, 0x5f0087, 0x5f00af,
  27     0x5f00d7, 0x5f00ff, 0x5f5f00, 0x5f5f5f, 0x5f5f87, 0x5f5faf, 0x5f5fd7,
  28     0x5f5fff, 0x5f8700, 0x5f875f, 0x5f8787, 0x5f87af, 0x5f87d7, 0x5f87ff,
  29     0x5faf00, 0x5faf5f, 0x5faf87, 0x5fafaf, 0x5fafd7, 0x5fafff, 0x5fd700,
  30     0x5fd75f, 0x5fd787, 0x5fd7af, 0x5fd7d7, 0x5fd7ff, 0x5fff00, 0x5fff5f,
  31     0x5fff87, 0x5fffaf, 0x5fffd7, 0x5fffff, 0x870000, 0x87005f, 0x870087,
  32     0x8700af, 0x8700d7, 0x8700ff, 0x875f00, 0x875f5f, 0x875f87, 0x875faf,
  33     0x875fd7, 0x875fff, 0x878700, 0x87875f, 0x878787, 0x8787af, 0x8787d7,
  34     0x8787ff, 0x87af00, 0x87af5f, 0x87af87, 0x87afaf, 0x87afd7, 0x87afff,
  35     0x87d700, 0x87d75f, 0x87d787, 0x87d7af, 0x87d7d7, 0x87d7ff, 0x87ff00,
  36     0x87ff5f, 0x87ff87, 0x87ffaf, 0x87ffd7, 0x87ffff, 0xaf0000, 0xaf005f,
  37     0xaf0087, 0xaf00af, 0xaf00d7, 0xaf00ff, 0xaf5f00, 0xaf5f5f, 0xaf5f87,
  38     0xaf5faf, 0xaf5fd7, 0xaf5fff, 0xaf8700, 0xaf875f, 0xaf8787, 0xaf87af,
  39     0xaf87d7, 0xaf87ff, 0xafaf00, 0xafaf5f, 0xafaf87, 0xafafaf, 0xafafd7,
  40     0xafafff, 0xafd700, 0xafd75f, 0xafd787, 0xafd7af, 0xafd7d7, 0xafd7ff,
  41     0xafff00, 0xafff5f, 0xafff87, 0xafffaf, 0xafffd7, 0xafffff, 0xd70000,
  42     0xd7005f, 0xd70087, 0xd700af, 0xd700d7, 0xd700ff, 0xd75f00, 0xd75f5f,
  43     0xd75f87, 0xd75faf, 0xd75fd7, 0xd75fff, 0xd78700, 0xd7875f, 0xd78787,
  44     0xd787af, 0xd787d7, 0xd787ff, 0xd7af00, 0xd7af5f, 0xd7af87, 0xd7afaf,
  45     0xd7afd7, 0xd7afff, 0xd7d700, 0xd7d75f, 0xd7d787, 0xd7d7af, 0xd7d7d7,
  46     0xd7d7ff, 0xd7ff00, 0xd7ff5f, 0xd7ff87, 0xd7ffaf, 0xd7ffd7, 0xd7ffff,
  47     0xff0000, 0xff005f, 0xff0087, 0xff00af, 0xff00d7, 0xff00ff, 0xff5f00,
  48     0xff5f5f, 0xff5f87, 0xff5faf, 0xff5fd7, 0xff5fff, 0xff8700, 0xff875f,
  49     0xff8787, 0xff87af, 0xff87d7, 0xff87ff, 0xffaf00, 0xffaf5f, 0xffaf87,
  50     0xffafaf, 0xffafd7, 0xffafff, 0xffd700, 0xffd75f, 0xffd787, 0xffd7af,
  51     0xffd7d7, 0xffd7ff, 0xffff00, 0xffff5f, 0xffff87, 0xffffaf, 0xffffd7,
  52     0xffffff, 0x080808, 0x121212, 0x1c1c1c, 0x262626, 0x303030, 0x3a3a3a,
  53     0x444444, 0x4e4e4e, 0x585858, 0x626262, 0x6c6c6c, 0x767676, 0x808080,
  54     0x8a8a8a, 0x949494, 0x9e9e9e, 0xa8a8a8, 0xb2b2b2, 0xbcbcbc, 0xc6c6c6,
  55     0xd0d0d0, 0xdadada, 0xe4e4e4, 0xeeeeee
  56 };
  57
  58 #define VGA_REG_OFF 0x0400
  59
  60 static int
  61 vga_pci_bind(struct device_def* devdef, morph_t* obj)
  62 {
  63     struct pci_probe* probe;
  64
  65     struct pci_base_addr* fb;
  66     struct pci_base_addr* mmio;
  67
  68     probe = changeling_reveal(obj, pci_probe_morpher);
  69     fb    = &probe->bar[0];
  70     mmio  = &probe->bar[2];
  71
  72     if (PCI_BAR_ADDR_IO(mmio->type)) {
  73         return EINVAL;
  74     }
  75
  76     pci_reg_t cmd = pci_read_cspace(probe->cspace_base, PCI_REG_STATUS_CMD);
  77
  78     cmd |= (PCI_RCMD_MM_ACCESS | PCI_RCMD_DISABLE_INTR | PCI_RCMD_BUS_MASTER);
  79
  80     pci_write_cspace(probe->cspace_base, PCI_REG_STATUS_CMD, cmd);
  81
  82     ptr_t fb_mapped = ioremap(fb->start, FB256K);
  83     ptr_t mmio_mapped = ioremap(mmio->start, mmio->size);
  84
  85     struct vga* vga_state =
  86       vga_new_state(mmio_mapped + VGA_REG_OFF, fb_mapped, FB256K);
  87     vga_state->reg_ops = vga_default_mmio_ops;
  88
  89     struct gfxa* vga_gfxa = gfxm_alloc_adapter(vga_state);
  90     extern struct gfxa_ops vga_gfxa_ops;
  91     vga_gfxa->ops = vga_gfxa_ops;
  92
  93     // Preload a VESA-compilant configuration
  94     vga_gfxa->disp_info = (struct disp_profile){
  95         .mon = { .w_px = 640, .h_px = 480, .freq = 60, .depth = 16 }
  96     };
  97
  98     gfxm_register(vga_gfxa);
  99
 100     return 0;
 101 }
 102
 103
 104 static bool
 105 vga_pci_compat(struct pci_probe* probe)
 106 {
 107 #define VGA_PCI_CLASS 0x30000
 108     return pci_device_class(probe) == VGA_PCI_CLASS;
 109 }
 110
 111 static int
 112 vga_pci_register(struct device_def* def)
 113 {
 114     return !pci_register_driver(def, vga_pci_compat);
 115 }
 116
 117 static struct device_def vga_pci_devdef = {
 118     def_device_class(GENERIC, DISP, VGA),
 119     def_device_name("Generic VGA"),
 120
 121     def_on_register(vga_pci_register),
 122     def_on_create(vga_pci_bind),
 123
 124     def_non_trivial
 125 };
 126 EXPORT_DEVICE(vga_pci, &vga_pci_devdef, load_onboot);