Stap 3: Arduino code
Bibliotheken en codes van github downloaden:
Belangrijkste code: https://github.com/BTeTapxu/Drift-car-code-arduino
Downloaden van de bibliotheek: https://github.com/pololu/dual-vnh5019-motor-shield
CODE:
#include "DualVNH5019MotorShield.h"
DualVNH5019MotorShield de motor;
unsigned char serial_in [7] = {};
int i = 0;
int analogPin = 3; Potentiometer aangesloten op analoge pin 3 int val = 0, comp;
VOID Setup {}
Serial.begin(19200);
motor.init();
}
void loop {}
motor_move();
Servo();
Serial.println(comp); debug
Als (Serial.available() > 0) {}
Als (ik == 6) {}
Ik = 0;
}
i ++;
serial_in[i]=Serial.Read();
}
}
ongeldig servo() {}
Als (comp < kaart (serial_in [4], 208,48, 14, 6)) {}
motor.setM2Speed(100);
}
anders als (comp > kaart (serial_in [4], 208,48, 14, 6)) {}
motor.setM2Speed(100);
}
else {}
motor.setM2Speed(0);
}
Comp = analogRead (analogPin) / 50;
}
ongeldig motor_move() {}
Als (serial_in [1] < 127) {}
motor.setM1Speed (kaart (serial_in [1], 127,50, 0 -400));
}
anders als (serial_in [1] > 129) {}
motor.setM1Speed (kaart (serial_in [1], 129,210, 0, 400));
}
else {}
motor.setM1Speed(0);
}
}