void Init_7566(int Addr){

/* Set up for x0-axis */

outp(MDR0(Addr + axis_0), (NQDX + FreeRun + RCNTR + ASYN_IDX));

outp(MDR1(Addr + axis_0), (CY + BW + CMP + DisFLGb + EnCNTR + Instnt_FLGa));

/* Set up for x1-axis */

outp(MDR0(Addr + axis_1), (QDX1 + FreeRun + RCNTR + SYN_IDX + FDF1));

outp(MDR1(Addr + axis_1), (CY + BW + CMP + IDX + DisFLGb + EnCNTR + Ltch_FLGa));

/* Set up for x2-axis */

outp(MDR0(Addr + axis_2), (QDX4 + ModN + DisIDX + FDF2));

outp(MDR1(Addr + axis_2), DisCNTR);

outp(PR0(Addr + axis_2), 0x56);

outp(PR1(Addr + axis_2), 0x34);

outp(PR2(Addr + axis_2), 0x12);

outp(CMR(Addr + axis_2), Ld_CNTR);

outp(MDR1(Addr + axis_2), (CY + BW + CMP + DisFLGb + EnCNTR + Ltch_FLGa));

/* Set up for x3-axis */

outp(MDR1(Addr + axis_3), DisCNTR);

}

/* Write_7566_PR

Input: Addr has address of 7566 counter

Data has 24 bit data to be written to PR Register of axis-x0 */

void Write_7566_PR(int Addr, unsigned long Data);

void Write_7566_PR(int Addr, unsigned long Data){

outp(PR0(Addr + axis_0), Data);

Data >>= 8;

outp(PR1(Addr + axis_0), Data);

Data >>= 8;

outp(PR2(Addr + axis_0), Data);

}

7566R-081507-17