Code:

#include "stdafx.h"
#include "rcservo.h"
#include "roboard.h"

int _tmain(int argc, _TCHAR* argv[])
{
   if (rcservo_Initialize(RCSERVO_USECHANNEL0))
   {
      printf("Channels 0 initialized");
      rcservo_EnterCaptureMode();
      rcservo_SetServo(0, RCSERVO_HITEC_HSR8498);
      unsigned long pos = rcservo_ReadPosition(0,0);
      unsigned long motion[32]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
      motion[1]=2300;
      rcservo_EnterPlayMode();
      rcservo_SetAction (motion, 500);
      while (rcservo_PlayAction() != RCSERVO_PLAYEND)
      {
      }
      rcservo_EnterPWMMode();
      unsigned long PWM_period = 10000;
      unsigned long PWM_duty = 1700;
      unsigned long count = 100;
      rcservo_SendPWMPulses(0, PWM_period, PWM_duty, count);
      while(!rcservo_IsPWMCompleted(0))
      {
      }
      rcservo_Close();
   }
   return 0;
}


Statistics: Posted by Sazabi — Sat Feb 06, 2010 12:05 am