【TI 技术资料分享】+ MSP430对舵机控制程序

只看该作者 · 2015-3-9 21:12

舵机程序 1



#include "msp430x14x.h"

#include "Servo.h"

float g_Scale=4;

void fadon(int x)

{

     for(int i=0;i<x;i++)

    {

      SetAngleLR(i,10);//100为步长，i为次数

    

      Delay(30);

     

    } 

}

void yidon(int y)

{

     for(int j=0;j<y;j++)

    {

      SetAngleLRa(j,10);//100为步长，i为次数

      Delay(30);

     

    } 

}

void main( void )

{

  // Stop watchdog timer to prevent time out reset

  WDTCTL = WDTPW + WDTHOLD;

  Clock_Init();

  Servo_Init();

  _EINT();

  for(;;)

  {

  fadon(20);  

  yidon(20); 

  }

}