drivers/staging/xgifb/vb_util.c

   1 #include "vgatypes.h"
   2
   3 void xgifb_reg_set(unsigned long port, u8 index, u8 data)
   4 {
   5         outb(index, port);
   6         outb(data, port + 1);
   7 }
   8
   9 u8 xgifb_reg_get(unsigned long port, u8 index)
  10 {
  11         u8 data;
  12
  13         outb(index, port);
  14         data = inb(port + 1);
  15         return data;
  16 }
  17
  18 void xgifb_reg_and_or(unsigned long port, u8 index,
  19                 unsigned data_and, unsigned data_or)
  20 {
  21         u8 temp;
  22
  23         temp = xgifb_reg_get(port, index); /* XGINew_Part1Port index 02 */
  24         temp = (temp & data_and) | data_or;
  25         xgifb_reg_set(port, index, temp);
  26 }
  27
  28 void xgifb_reg_and(unsigned long port, u8 index, unsigned data_and)
  29 {
  30         u8 temp;
  31
  32         temp = xgifb_reg_get(port, index); /* XGINew_Part1Port index 02 */
  33         temp &= data_and;
  34         xgifb_reg_set(port, index, temp);
  35 }
  36
  37 void xgifb_reg_or(unsigned long port, u8 index, unsigned data_or)
  38 {
  39         u8 temp;
  40
  41         temp = xgifb_reg_get(port, index); /* XGINew_Part1Port index 02 */
  42         temp |= data_or;
  43         xgifb_reg_set(port, index, temp);
  44 }