test6-2.c

来自「固高GT400运动控制卡」· C语言 代码 · 共 76 行

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <conio.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 value;
 char *str;
 rtn=GT_Open();           error(rtn);
 rtn=GT_Reset();          error(rtn);
 rtn=GT_LmtSns(0);        error(rtn);
 rtn=GT_Axis(1);          error(rtn);
 rtn=GT_ClrSts();         error(rtn);
 rtn=GT_OpenLp();         error(rtn);
 rtn=GT_AxisOn();         error(rtn);
 clrscr();
 printf("Quit: Press Q! \n");
 value=0;
 while (1)
    {
      rtn=GT_SetMtrCmd(value);  error(rtn);
      rtn=GT_Update();          error(rtn);
      printf("Please input a new value (-32767<value<32767):");
      gets(str);
      if(!(strcmpi(str,"Q")))
       {
	 rtn=GT_Reset();        error(rtn);
	 return;
	 }
       value=atol(str);
       }
      GT_Close();               error(rtn);
 }