Dobot AiStarter - Page 27

AiStarter User Guide 6AI-Starter Demo
IssueV1.0.3（2018-09-01） AiStarter User Guide Copyright © Yuejiang Technology Co., Ltd
22
Program 6.4 Initialize AI-Starter
AIStarter_SmartBotInit();
2) Put the ultrasonic sensor values into the array dis.
Program 6.5 Save ultrasonic sensor values
dis[0] = AIStarter_SmartBotGetSonar(SONAR1);
dis[1] = AIStarter_SmartBotGetSonar(SONAR2);
dis[2] = AIStarter_SmartBotGetSonar(SONAR3);
3) Set turning mode according to the distance between obstacle and AI-Starter.
Program 6.6 Set turning mode
if(dis[0] > 2*DIS ){
motorStatus = AHEAD;
}else if(dis[0] > DIS && dis[0] < 2*DIS ){
motorStatus = motorStatus;
}else if(dis[0] > 0 && dis[0] < DIS ){
motorStatus = BACKRIGHT;
break;
}
if(dis[1] > 2*DIS ){
motorStatus = AHEAD;
}else if(dis[1] > DIS && dis[1] < 2*DIS ){
motorStatus = motorStatus;
}else if(dis[1] > 0 && dis[1] < DIS ){
motorStatus = BACKRIGHT;
break;
}
if(dis[2] > 2*DIS ){
motorStatus = AHEAD;
}else if(dis[2] > DIS && dis[2] < 2*DIS ){
motorStatus = motorStatus;
}else if(dis[2] > 0 && dis[2] < DIS ){
motorStatus = BACKLEFT;
break;
}