src/drivers/pc80/vga/vga.c

   1 /*
   2  * Copyright (C)  2007-2009  Luc Verhaegen <libv@skynet.be>
   3  *
   4  * This program is free software; you can redistribute it and/or modify it
   5  * under the terms of the GNU General Public License as published by the Free
   6  * Software Foundation; either version 2 of the License, or (at your option)
   7  * any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  */
  14
  15 #include <pc80/vga.h>
  16 #include <pc80/vga_io.h>
  17
  18 #include <string.h>
  19 #include "vga.h"
  20
  21 /*
  22  * pci io enable should've happened before
  23  */
  24 void
  25 vga_io_init(void)
  26 {
  27         vga_enable_mask(0x01, 0x01);
  28
  29         /* cr io is at 0x3D4/0x3D5 */
  30         vga_misc_mask(0x01, 0x01);
  31
  32         /* clear cr0-7 protection */
  33         vga_cr_mask(0x11, 0x00, 0x80);
  34 }
  35
  36 /*
  37  *
  38  */
  39 static void
  40 vga_fb_init(void)
  41 {
  42         vga_sr_write(0x02, 0x03);
  43         vga_sr_write(0x03, 0x00);
  44         vga_sr_write(0x04, 0x02); /* access all 256kB */
  45
  46         vga_gr_write(0x00, 0x00);
  47         vga_gr_write(0x01, 0x00);
  48         vga_gr_write(0x02, 0x00);
  49         vga_gr_write(0x03, 0x00);
  50         vga_gr_write(0x04, 0x00);
  51         vga_gr_write(0x05, 0x10);
  52         vga_gr_write(0x06, 0x0E); /* map at 0xB8000 */
  53         vga_gr_write(0x07, 0x00);
  54         vga_gr_write(0x08, 0xFF);
  55
  56         /* o/e enable: ram enable */
  57         vga_misc_mask(0x22, 0x22);
  58 }
  59
  60 /*
  61  *
  62  */
  63 static void
  64 vga_fb_clear(void)
  65 {
  66         memset((void *)VGA_FB, 0x00, 0x8000);
  67 }
  68
  69 /*
  70  *
  71  */
  72 static void
  73 vga_palette_init(void)
  74 {
  75         unsigned int i;
  76
  77         /* set up attribute registers */
  78         for (i = 0; i < 0x10; i++)
  79                 vga_ar_write(i, i);
  80
  81         vga_ar_write(0x10, 0x0c);
  82         vga_ar_write(0x11, 0x00);
  83         vga_ar_write(0x12, 0x0F);
  84         vga_ar_write(0x13, 0x08);
  85         vga_ar_write(0x14, 0x00);
  86
  87         vga_palette_disable();
  88
  89         /* load actual palette */
  90         vga_dac_mask_write(0xFF);
  91
  92         for (i = 0; i < 0x100; i++) {
  93                 vga_dac_write_address(i);
  94                 vga_dac_data_write(default_vga_palette[i].red);
  95                 vga_dac_data_write(default_vga_palette[i].green);
  96                 vga_dac_data_write(default_vga_palette[i].blue);
  97         }
  98 }
  99
 100 /*
 101  *
 102  */
 103 static void
 104 vga_mode_set(int hdisplay, int hblankstart, int hsyncstart, int hsyncend,
 105              int hblankend, int htotal, int vdisplay, int vblankstart,
 106              int vsyncstart, int vsyncend, int vblankend, int vtotal,
 107              int stride)
 108 {
 109         /* htotal: 2080 */
 110         htotal /= 8;
 111         htotal -= 5;
 112         vga_cr_write(0x00, htotal);
 113
 114         /* hdisplay: 2048 */
 115         hdisplay /= 8;
 116         hdisplay -= 1;
 117         vga_cr_write(0x01, hdisplay);
 118
 119         /* hblankstart: 2048 */
 120         hblankstart /= 8;
 121         hblankstart -= 1;
 122         vga_cr_write(0x02, hblankstart);
 123
 124         /* hblankend: hblankstart + 512 */
 125         hblankend /= 8;
 126         hblankend -= 1;
 127         vga_cr_mask(0x03, hblankend, 0x1F);
 128         vga_cr_mask(0x05, hblankend << 2, 0x80);
 129
 130         /* hsyncstart: 255 * 8: 2040 */
 131         vga_cr_write(0x04, hsyncstart / 8);
 132
 133         /* hsyncend: hsyncstart + 255 */
 134         vga_cr_mask(0x05, hsyncend / 8, 0x1F);
 135
 136         /* vtotal: 1025 */
 137         vtotal -= 2;
 138         vga_cr_write(0x06, vtotal);
 139         vga_cr_mask(0x07, vtotal >> 8, 0x01);
 140         vga_cr_mask(0x07, vtotal >> 4, 0x20);
 141
 142         /* vdisplay: 1024 */
 143         vdisplay -= 1;
 144         vga_cr_write(0x12, vdisplay);
 145         vga_cr_mask(0x07, vdisplay >> 7, 0x02);
 146         vga_cr_mask(0x07, vdisplay >> 3, 0x40);
 147
 148         /* vblankstart: 1024 */
 149         vblankstart -= 1;
 150         vga_cr_write(0x15, vblankstart);
 151         vga_cr_mask(0x07, vblankstart >> 5, 0x08);
 152         vga_cr_mask(0x09, vblankstart >> 4, 0x20);
 153
 154         /* vblankend: vblankstart + 256 */
 155         vblankend -= 1;
 156         vga_cr_write(0x16, vblankend);
 157
 158         /* vsyncstart: 1023 */
 159         vga_cr_write(0x10, vsyncstart);
 160         vga_cr_mask(0x07, vsyncstart >> 6, 0x04);
 161         vga_cr_mask(0x07, vsyncstart >> 2, 0x80);
 162
 163         /* vsyncend: vsyncstart + 16 */
 164         vga_cr_mask(0x11, vsyncend, 0x0F);
 165
 166         /* stride */
 167         vga_cr_write(0x13, stride / 8);
 168
 169         /* line compare */
 170         vga_cr_write(0x18, 0xFF);
 171         vga_cr_mask(0x07, 0x10, 0x10);
 172         vga_cr_mask(0x09, 0x40, 0x40);
 173
 174         vga_misc_mask(0x44, 0xCC); /* set up clock: 27mhz and h/vsync */
 175
 176         vga_cr_mask(0x09, 0x00, 0x80); /* disable doublescan */
 177 }
 178
 179 static void
 180 vga_font_8x16_load(void)
 181 {
 182         unsigned char *p;
 183         int i, j;
 184         unsigned char sr2, sr4, gr5, gr6;
 185
 186 #define height 16
 187 #define count 256
 188
 189         sr2 = vga_sr_read(0x02);
 190         sr4 = vga_sr_read(0x04);
 191         gr5 = vga_gr_read(0x05);
 192         gr6 = vga_gr_read(0x06);
 193
 194         /* disable odd/even */
 195         vga_sr_mask(0x04, 0x04, 0x04);
 196         vga_gr_mask(0x05, 0x00, 0x10);
 197         vga_gr_mask(0x06, 0x00, 0x02);
 198
 199         /* plane 2 */
 200         vga_sr_write(0x02, 0x04);
 201         p = (unsigned char *) VGA_FB;
 202         for (i = 0; i < count; i++) {
 203                 for (j = 0; j < 32; j++) {
 204                         if (j < height)
 205                                 *p = vga_font_8x16[i][j];
 206                         else
 207                                 *p = 0x00;
 208                         p++;
 209                 }
 210         }
 211
 212         vga_gr_write(0x06, gr6);
 213         vga_gr_write(0x05, gr5);
 214         vga_sr_write(0x04, sr4);
 215         vga_sr_write(0x02, sr2);
 216
 217         /* set up font size */
 218         vga_cr_mask(0x09, 16 - 1, 0x1F);
 219 }
 220
 221 /*
 222  *
 223  */
 224 void
 225 vga_cursor_enable(int enable)
 226 {
 227         if (enable)
 228                 vga_cr_mask(0x0A, 0x00, 0x20);
 229         else
 230                 vga_cr_mask(0x0A, 0x20, 0x20);
 231 }
 232
 233 /*
 234  *
 235  */
 236 void
 237 vga_cursor_reset(void)
 238 {
 239         vga_cr_write(0x0A, 0x2E);
 240         vga_cr_write(0x0B, 0x0E);
 241         vga_cr_write(0x0E, 0x00);
 242         vga_cr_write(0x0F, 0x00);
 243 }
 244
 245 /*
 246  *
 247  */
 248 void
 249 vga_cursor_set(unsigned int line, unsigned int character)
 250 {
 251         unsigned int offset = (80 * line + character) & 0xFFFF;
 252
 253         vga_cr_write(0x0A, 0x0E);
 254         vga_cr_write(0x0B, 0x0E);
 255         vga_cr_write(0x0E, offset >> 8);
 256         vga_cr_write(0x0F, offset & 0xFF);
 257 }
 258
 259 /*
 260  *
 261  */
 262 void
 263 vga_frame_set(unsigned int line, unsigned int character)
 264 {
 265         unsigned int offset = (80 * line + character) & 0xFFFF;
 266
 267         vga_cr_write(0x0C, offset >> 8);
 268         vga_cr_write(0x0D, offset & 0xFF);
 269 }
 270
 271 /*
 272  * simply fills a line with the given string.
 273  */
 274 void
 275 vga_line_write(unsigned int line, const char *string)
 276 {
 277         unsigned short *p = (unsigned short *) VGA_FB + (80 * line);
 278         int i, len = strlen(string);
 279
 280         for (i = 0; i < 80; i++) {
 281                 if (i < len)
 282                         p[i] = 0x0F00 | string[i];
 283                 else
 284                         p[i] = 0x0F00;
 285         }
 286 }
 287
 288 /*
 289  * set up everything to get a basic 80x25 textmode.
 290  */
 291 void
 292 vga_textmode_init(void)
 293 {
 294         vga_sr_write(0x00, 0x01); /* clear reset */
 295         vga_sr_write(0x01, 0x00);
 296
 297         /* set up cr */
 298         vga_cr_mask(0x03, 0x80, 0xE0);
 299         vga_cr_mask(0x05, 0x00, 0x60);
 300
 301         vga_cr_write(0x08, 0x00);
 302
 303         vga_cr_write(0x14, 0x00); /* */
 304
 305         vga_cr_write(0x17, 0x23);
 306
 307         vga_palette_init();
 308
 309         vga_mode_set(640, 648, 680, 776, 792, 800,
 310                      400, 407, 412, 414, 442, 449, 320);
 311
 312         vga_cursor_reset();
 313         vga_frame_set(0, 0);
 314
 315         vga_fb_init();
 316         vga_fb_clear();
 317         vga_font_8x16_load();
 318
 319         vga_sr_mask(0x00, 0x02, 0x02); /* take us out of reset */
 320         vga_cr_mask(0x17, 0x80, 0x80); /* sync! */
 321 }