舵机程序 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);
- }
- }
| 
楼主
