|
|
#include <Servo.h>
Servo sv5;
Servo sv9;
const int sv5Pin = 8;
const int sv9Pin = 9;
const int every555 = 15;
const int every999 = 50;
unsigned long last555 = 0;
unsigned long last999 = 0;
int dir5 = 1;
int dir9 = -1;
int pos555 = 90;
int pos999 = 90;
void setup() {
sv9.attach(sv9Pin);
sv5.attach(sv5Pin);
Serial.begin(9600);
sv9.write(pos999);
sv5.write(pos555);
Serial.println("Test 2 Serbo");
delay(568);
}
void loop( ) {
check555( );
check999( );
check888( );
}
void check555( ) {
if(millis( ) - last555 < every555) return;
last555 = millis( );
pos555 += dir5;
sv5.write(pos555);
if(dir5 == 1){
if(pos555 >179) dir5 = -1;
}else{
if(pos555 < 1) dir5 = 1;
}
}
void check999( ) {
if(millis( ) - last999 < every999) return;
last999 = millis( );
pos999 += dir9;
sv9.write(pos999);
if(dir9 == 1){
if(pos999 >179) dir9 = -1;
}else{
if(pos999 < 1) dir9 = 1;
}
}
void check888( ) {
// more Servo ?
}
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
