developing drivers for custom boards

component fc1;

pin in bit pin-##-out[24] "output pins";<<<<<<<<<<<<<<<<<<<<<<used to be 32, not 24
pin out bit pin-##-in[24] "input pins";
pin in unsigned SP-out "speed/temp value";
pin out unsigned R0-in;
pin out unsigned R1-in;
pin out unsigned R2-in;
pin out unsigned R3-in;
pin out unsigned R0-out;
pin out unsigned R1-out;
pin out unsigned R2-out;
pin out unsigned R3-out;

function read nofp;
function write nofp;

variable unsigned base_addr;

option count_function yes;
option extra_setup yes;

modparam dummy ioaddr """Base address of card. Separate each card base address
with a comma but no space to load more than one card. eg
loadrt fc1 ioaddr=0x378,0xdf00. use 0xNNN to define addresses in Hex""";

modparam dummy con """Configuration values for card. Seperate each value with
a comma and no spaces. 12 values are expected, see readme for value explanation"""

license "GPL";
author "Andy Pugh modified by Bert Lewis";
;;

#include <asm/io.h>
#define MAX_CHAN 8

static int con[12] = {0,0,0,4,5,6,7,8,9,10,11,12};
RTAPI_MP_ARRAY_INT(con,12,"configs")

static int ioaddr[MAX_CHAN] = {0x378, -1, -1, -1, -1, -1, -1, -1};
RTAPI_MP_ARRAY_INT(ioaddr, MAX_CHAN, "Base addresses")

FUNCTION(read){
unsigned char R0, R1, R2;
int i;
R0 = inb(base_addr + 3);
R1 = inb(base_addr + 4);
R2 = inb(base_addr + 4);

R0_in = R0;
R1_in = R1;
R2_in = R2;

for (i = 0;i <= 7;i++){
pin_in(i) = R0 & (1 << i);
pin_in(i+8) = R1 & (1 << i);
pin_in(i+16) = R2 & (1 << i);
}
}

FUNCTION(write){
unsigned char R0, R1, R2, SPi;
int i;
R0 = 0;
R1 = 0;
R2 = 0;<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<Used to have R3=0 after this line
for (i = 0;i <= 7;i++){
R0 |= pin_out(i) << i;
R1 |= pin_out(i+8) << i;
R2 |= pin_out(i+16) << i;<<<<<<<<<<<<<<<<<<<<<<There was a line after this to get R3 |=pin_out(i+24)<<i;
}
SPi = SP_out;

outb(R0, base_addr + 3);
outb(R1, base_addr + 4);
outb(R2, base_addr + 4);
outb(SPi, base_addr + 4);<<<<<<<<<<<<<<<<<<<<<<<This used to be R3, not SPi

R0_out = R0;
R1_out = R1;
R2_out = R2;

}

EXTRA_SETUP(){
int c;
if (ioaddr[extra_arg] > 0) {
base_addr = ioaddr[extra_arg];
rtapi_print("Loading EPP custom board driver at base addr %X\n", base_addr);
c=inb(base_addr+0x402);
c=c&0x1f;
c=c|0x80;
outb(c,base_addr+0x402);
outb(4,base_addr+2);

outb (0,base_addr+3);
for (c=0;c<12;c++){
outb(con[c],base_addr+4);
}
rtapi_print("made it past EPP setup\n");
return 0;
}
rtapi_print("Seems we are returning -EINVAL %X\n",EINVAL);
return -EINVAL;
}

int get_count(void){
int i;
for (i=0; ioaddr[i] > 0 && i < MAX_CHAN; i++){}
rtapi_print("down here in get count, i = %X\n", i);
return i;
}