| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374 |
- package boebot;
- import stamp.core.*;
- public class BoeBot{
- MotorAansturing motor;
- Botsingdetectie botsingdetectie;
- FysiekeIndicator fysiekeindicator;
- public BoeBot(){
- motor = new MotorAansturing();
- botsingdetectie = new Botsingdetectie();
- fysiekeindicator = new FysiekeIndicator();
- motor.setSnelheid(100);
- motor.setRichting(true);
- motor.start();
- while(true){
- if(botsingdetectie.detectEdge()){
- CPU.writePin(CPU.pin1,true);
- motor.noodStop();
- motor.setRichting(false);
- motor.start();
- CPU.delay(2000);
- motor.noodStop();
- motor.turn(180);
- motor.setRichting(true);
- motor.start();
- }else if(botsingdetectie.detectObject() == 1){
- motor.noodStop();
- motor.setRichting(false);
- motor.start();
- CPU.delay(2000);
- motor.noodStop();
- motor.turn(90);
- motor.setRichting(true);
- motor.start();
- }else if(botsingdetectie.detectObject() == 2){
- motor.noodStop();
- motor.setRichting(false);
- motor.start();
- CPU.delay(2000);
- motor.noodStop();
- motor.turn(270);
- motor.setRichting(true);
- motor.start();
- }else if(botsingdetectie.detectObject() == 3){
- motor.noodStop();
- motor.setRichting(false);
- motor.start();
- CPU.delay(2000);
- motor.noodStop();
- motor.turn(180);
- motor.setRichting(true);
- motor.start();
- }
- int getal = afir.detect(4);
- if(getal == 21)
- {
- afir.setStatus(!afir.getStatus());
- }
- if(afir.getStatus())
- {
- if(getal != -1){
- afir.verwerkSignaal(getal);
- }
- else
- {
- //some other code
- }
- }
- }
- }
|