test6-3.c

固高GT400运动控制卡

#include <stdio.h>
#include <conio.h>
#include <bios.h>
#include <dos.h>
#include "userlib.h"

short rtn;

void error(short rtn)
{
   switch (rtn)
   {
      case -1:
	   printf("error: communciation error\n");
	   break;
      case 0:
	   /* No error */
	   break;
      case 1:
	   printf("error: command error\n");
	   break;
      case 2:
	   printf("error: radius is zero or too large\n");
	   break;
      case 3:
	   printf("error: the length of line is zero or too large\n");
	   break;
      case 4:
	   printf("error: acceleration or velocity is zero or too large\n");
	   break;
      case 5:
	   printf("error: parameter conflict\n");
	   break;
      case 6:
	   printf("error: nonexistence solution for the equation\n");
	   break;
      case 7:
	   printf("error: process parameter error\n");
	   break;
      default:
	   break;
   }
}


void main()
{
 long actl_pos;
 rtn=GT_Open();          error(rtn);
 rtn=GT_Reset();         error(rtn);
 rtn=GT_LmtSns(0);       error(rtn);
 rtn=GT_EncSns(0);       error(rtn);
 rtn=GT_Axis(1);         error(rtn);
 rtn=GT_AxisOff();       error(rtn);
 clrscr();
 printf("Please turn the first axis!\n");
 printf("Press anykey exit!\n");
 printf("Actual position:");
 window(20,3,40,3);
 while (1)
  {
    rtn=GT_GetAtlPos(&actl_pos);  error(rtn);
    cprintf("%ld",actl_pos);
    delay(1000);
    clrscr();
    if(bioskey(1))
    break;
   }
 rtn=GT_Reset();                  error(rtn);
 rtn=GT_Close();                  error(rtn);
 }