1 files changed, 68 insertions, 0 deletions
diff --git a/src/drivers/intel/gma/text_fb/gma-gfx_init.adb b/src/drivers/intel/gma/text_fb/gma-gfx_init.adb
new file mode 100644
index 0000000000..038b76b26a
--- /dev/null
+++ b/src/drivers/intel/gma/text_fb/gma-gfx_init.adb
@@ -0,0 +1,68 @@
+with HW.GFX;
+with HW.GFX.GMA;
+with HW.GFX.GMA.Display_Probing;
+
+use HW.GFX;
+use HW.GFX.GMA;
+use HW.GFX.GMA.Display_Probing;
+
+with GMA.Mainboard;
+
+package body GMA.GFX_Init
+is
+
+   function fill_lb_framebuffer
+     (framebuffer : in out lb_framebuffer)
+      return Interfaces.C.int
+   is
+      use type Interfaces.C.int;
+   begin
+      return -1;
+   end fill_lb_framebuffer;
+
+   ----------------------------------------------------------------------------
+
+   procedure gfxinit (lightup_ok : out Interfaces.C.int)
+   is
+      ports : Port_List;
+      configs : Pipe_Configs;
+
+      success : boolean;
+
+      -- from pc80/vga driver
+      procedure vga_io_init;
+      pragma Import (C, vga_io_init, "vga_io_init");
+      procedure vga_textmode_init;
+      pragma Import (C, vga_textmode_init, "vga_textmode_init");
+   begin
+      lightup_ok := 0;
+
+      HW.GFX.GMA.Initialize (Success => success);
+
+      if success then
+         ports := Mainboard.ports;
+         HW.GFX.GMA.Display_Probing.Scan_Ports
+           (Configs  => configs,
+            Ports    => ports,
+            Max_Pipe => Primary);
+
+         if configs (Primary).Port /= Disabled then
+            HW.GFX.GMA.Power_Up_VGA;
+            vga_io_init;
+            vga_textmode_init;
+
+            -- override probed framebuffer config
+            configs (Primary).Framebuffer.Width    := 640;
+            configs (Primary).Framebuffer.Height   := 400;
+            configs (Primary).Framebuffer.Offset   :=
+               VGA_PLANE_FRAMEBUFFER_OFFSET;
+
+            HW.GFX.GMA.Dump_Configs (configs);
+            HW.GFX.GMA.Update_Outputs (configs);
+
+            lightup_ok := 1;
+         end if;
+      end if;
+   end gfxinit;
+
+end GMA.GFX_Init;