Stap 13: De code - Joysticks
Dit is een makkelijke gedeelte, ik gebruik gewoon de kaart functie te wijzigen van een int volgens potentiometer waarden. Op kaart functie gebruik ik de max en min op elke potentiometers die ik bewaar in Eprom met aan optie. Zo voor gashendel zoiets als dit is:
throttle = map (th_pot, EEPROMReadInt(20), EEPROMReadInt(18), EEPROMReadInt(40), EEPROMReadInt(42));
th pot is de analoge waarde van analoge pin leest.
EPROM-adressen: 20 - de max gaspedaal, de waarde van de potentiometer
18 - de min gashendel, potentiometer waarde
40 - de max gaspedaal, PWM of ESC waarde
42 - de min gaspedaal, PWM of ESC waarde
Ook zul hier je aan het proces de automatische piloot, divider en omgekeerde steer.
if (EEPROMReadInt(70) == 1) { //if autopilot is on if (throttle > count_throttle){ count_throttle = throttle; } if (throttle < count_throttle){ throttle = count_throttle; } if (break_ < (EEPROMReadInt(50) - 5)){ //if hit break set throttle 0, autopilot off count_throttle = 0; throttle = 0; EEPROMWriteInt(70, 0); } }
//th divider switch (EEPROMReadInt(74)) { case 1: throttle *= 0.25; break; case 2: throttle *= 0.5; break; case 3: throttle *= 0.75; break; }