DFRobot ROB0117 Manuale di avvio rapido - Pagina 10
Sfoglia online o scarica il pdf Manuale di avvio rapido per Microcontrollori DFRobot ROB0117. DFRobot ROB0117 13. Basic kit for cherokey 4wd
Stampa la pagina2015/11/4
}
void SensorSetup(){
pinMode(URTRIG,OUTPUT);
digitalWrite(URTRIG,HIGH);
pinMode(URPWM, INPUT);
for(int i=0;i<4;i++){
Serial.write(EnPwmCmd[i]);
}
}
int MeasureDistance(){
digitalWrite(URTRIG, LOW);
digitalWrite(URTRIG, HIGH);
unsigned long distance=pulseIn(URPWM,LOW);
if(distance==50000){
Serial.print("Invalid");
}else{
distance=distance/50;
}
return distance;
}
void servoSweep(){
if(sweepFlag ){
if(pos>=60 && pos<=120){
pos=pos+1;
myservo.write(pos);
}
if(pos>119) sweepFlag = false;
}else {
if(pos>=60 && pos<=120){
pos=pos-1;
myservo.write(pos);
}
if(pos<61) sweepFlag = true;
}
}
STEP 5: Debugging Robot
1. Fix the upper Plate
https://www.dfrobot.com/wiki/index.php?title=Basic_Kit_for_Cherokey_4WD_SKU:ROB0117
Basic Kit for Cherokey 4WD SKU:ROB0117 - Robot Wiki
// A low pull on pin COMP/TRIG
// Set to HIGH
// Sending Enable PWM mode command
// a low pull on pin COMP/TRIG triggering a sensor reading
// reading Pin PWM will output pulses
// the reading is invalid.
// every 50us low level stands for 1cm
// in steps of 1 degree
// tell servo to go to position in variable 'pos'
// assign the variable again
10/13