moverobo.c~

来自「一个由c转成java的3D robot 仿真平台」· C~ 代码 · 共 41 行

#include "/usr/local/java/include/StubPreamble.h"
#include "../RealRobot_SerialOut.h"
#include <stdio.h>


void RealRobot_SerialOut_moverobo(struct HRealRobot_SerialOut *this, 
				  long arm, long pos, long task)
{
    static FILE *datei;

    if (task == 0)
      {
	/* Open File */
	datei=fopen("/dev/ttya","w"); 
	return;
      }

    if (task == 1)
      {
	/* Execute a movement */
        if ((arm >= 0) && (arm < 5) && (pos > 0) && (pos < 255))
          {
	    if (datei != NULL)
	      {
		fputc(255,datei);
		fputc((int)arm,datei);
		fputc((int)pos,datei);
		fflush(datei);
	      }
	  }
	return;
      }

    if (task == 2)
      {
	/* Close File */
	fclose(datei);
	return;
      }
}