drivers/staging/xgifb/vb_util.c

   1 #include "vb_def.h"
   2 #include "vgatypes.h"
   3 #include "vb_struct.h"
   4
   5 #include "XGIfb.h"
   6 #include <asm/io.h>
   7 #include <linux/types.h>
   8
   9 #include "vb_util.h"
  10
  11 void xgifb_reg_set(unsigned long port, unsigned short index,
  12                 unsigned short data)
  13 {
  14         outb(index, port);
  15         outb(data, port + 1);
  16 }
  17
  18 unsigned char XGINew_GetReg1(unsigned long port, unsigned short index)
  19 {
  20         unsigned char data;
  21
  22         outb(index, port);
  23         data = inb(port + 1);
  24         return data;
  25 }
  26
  27 void XGINew_SetRegANDOR(unsigned long Port, unsigned short Index,
  28                 unsigned short DataAND, unsigned short DataOR)
  29 {
  30         unsigned short temp;
  31
  32         temp = XGINew_GetReg1(Port, Index); /* XGINew_Part1Port index 02 */
  33         temp = (temp & (DataAND)) | DataOR;
  34         xgifb_reg_set(Port, Index, temp);
  35 }
  36
  37 void XGINew_SetRegAND(unsigned long Port, unsigned short Index,
  38                 unsigned short DataAND)
  39 {
  40         unsigned short temp;
  41
  42         temp = XGINew_GetReg1(Port, Index); /* XGINew_Part1Port index 02 */
  43         temp &= DataAND;
  44         xgifb_reg_set(Port, Index, temp);
  45 }
  46
  47 void XGINew_SetRegOR(unsigned long Port, unsigned short Index,
  48                 unsigned short DataOR)
  49 {
  50         unsigned short temp;
  51
  52         temp = XGINew_GetReg1(Port, Index); /* XGINew_Part1Port index 02 */
  53         temp |= DataOR;
  54         xgifb_reg_set(Port, Index, temp);
  55 }