test6-1.c

来自「GT400运动控制卡控制程序」· C语言 代码 · 共 60 行

#include "userlib.h"
#include <stdio.h>

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()
{
  short rtn;
  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_StepDir();       error(rtn);
  rtn=GT_AxisOn();        error(rtn);

  rtn=GT_SetVel(1);       error(rtn);
  rtn=GT_SetAcc(0.5);     error(rtn);
  rtn=GT_SetPos(16000);   error(rtn);
  rtn=GT_Update();        error(rtn);
  rtn=GT_Close();         error(rtn);
 }