pm511c.c

来自「pc104接口在arm9200开发板上的驱动程序」· C语言 代码 · 共 59 行

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <fcntl.h>
#include <time.h>
#include <errno.h>

#define chnum 8
unsigned long ulaverage[chnum],chazhi[chnum],num=0;
char* dev={"/dev/zt_io-0"};

void outport(int fd,long addr,long v){
long uldata[2];
  uldata[0]=addr;uldata[1]=v;
  write(fd,uldata,16);
}

long inport(int fd,long addr){
long uldata[2];
  uldata[0]=addr;uldata[1]=0;
  read(fd,uldata,16);
  return uldata[1];
}

void outportb(int fd,long addr,long v){
long uldata[2];
  uldata[0]=addr;uldata[1]=v;
  write(fd,uldata,8);
}

long inportb(int fd,long addr){
long uldata[2];
  uldata[0]=addr;uldata[1]=0;
  read(fd,uldata,8);
  return uldata[1];
}

int main(){
  int fd;
  unsigned long uldata[3];
  int i=0,l=0,h=0,v=0,devnum=1;
  int base=0x100;
  fd=open(dev,O_RDWR);
  if(!fd){printf("open zt_io error!\n");return 0;}
  outportb(fd,base+0xf,0xb4);
  outportb(fd,base+0xe,0xff);
  outportb(fd,base+0xe,0xff);
  while(1){
    v=inportb(fd,base+0xc)+inportb(fd,base+0xc)*0x100;
    printf("%10x",v);
    v=inportb(fd,base+0xd)+inportb(fd,base+0xd)*0x100;
    printf("%10x",v);
    v=inportb(fd,base+0xe)+inportb(fd,base+0xe)*0x100;
    printf("%10x\n",v);
    usleep(100000);
  }
  return 0;
}