thinkode/Zendrive-simulator
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fonctionnalité de repérage auto. lors du démarrage

Browse Source
This commit is contained in:
=
2021-01-27 14:34:44 +01:00
parent b668a01416
commit 562a43a6dd
1 changed files with 125 additions and 103 deletions
Download Patch File Download Diff File Expand all files Collapse all files

228
ZenDrive Simulator/ZenDrive Simulator.ino
View File

@@ -25,6 +25,11 @@ const int ROAD_LIGHTS_PIN = 16;
const int HEAD_LIGHTS_PIN = 14; const int HEAD_LIGHTS_PIN = 14;
const int FOG_LIGHTS_PIN = 15; const int FOG_LIGHTS_PIN = 15;
// Enabling modules
const bool USE_GEARSHIFT = true;
const bool USE_PEDALS = true;
const bool USE_WHEEL = true;
const int INTERVAL = 15; const int INTERVAL = 15;
void setup() { void setup() {
@@ -53,59 +58,63 @@ void setup() {
// Send current states // Send current states
/* Gearshift */ /* Gearshift */
int value = analogRead(SPEEDS_PIN); if(USE_GEARSHIFT){
if(value < 200) ZenDrive.switchSpeed1(); int value = analogRead(SPEEDS_PIN);
else if(value < 326) ZenDrive.switchSpeed2(); if(value < 200) ZenDrive.switchSpeed1();
else if(value < 421) ZenDrive.switchSpeed3(); else if(value < 326) ZenDrive.switchSpeed2();
else if(value < 493) ZenDrive.switchSpeed4(); else if(value < 421) ZenDrive.switchSpeed3();
else if(value < 551) ZenDrive.switchSpeed5(); else if(value < 493) ZenDrive.switchSpeed4();
else if(value < 596) ZenDrive.switchSpeed6(); else if(value < 551) ZenDrive.switchSpeed5();
else if(value < 634) ZenDrive.switchSpeedR(); else if(value < 596) ZenDrive.switchSpeed6();
else ZenDrive.switchNeutral(); else if(value < 634) ZenDrive.switchSpeedR();
//Read handbrake else ZenDrive.switchNeutral();
ZenDrive.setHandbrake(map(analogRead(HANDBRAKE_PIN), 0, 1023, 0, 255)); //Read handbrake
ZenDrive.sendGearshiftStates(); ZenDrive.setHandbrake(map(analogRead(HANDBRAKE_PIN), 0, 1023, 0, 255));
ZenDrive.sendGearshiftStates();
}
/* Pedals module */ /* Pedals module */
// Read clutch if(USE_PEDALS){
ZenDrive.setClutch(map(analogRead(CLUTCH_PIN), 0, 1023, 0, 255)); // Read clutch
// Read brake ZenDrive.setClutch(map(analogRead(CLUTCH_PIN), 0, 1023, 0, 255));
ZenDrive.setBrake(map(analogRead(BRAKE_PIN), 0, 1023, 0, 255)); // Read brake
// Read accelerator ZenDrive.setBrake(map(analogRead(BRAKE_PIN), 0, 1023, 0, 255));
ZenDrive.setAccelerator(map(analogRead(ACCELERATOR_PIN), 0, 1023, 0, 255)); // Read accelerator
ZenDrive.sendPedalsStates(); ZenDrive.setAccelerator(map(analogRead(ACCELERATOR_PIN), 0, 1023, 0, 255));
ZenDrive.sendPedalsStates();
}
/* Steering wheel module */ /* Steering wheel module */
// Left blinker if(USE_WHEEL){
if(digitalRead(LEFT_BLINKER_PIN)){ // Blinkers
ZenDrive.setBlinkerLeft(true); if(digitalRead(LEFT_BLINKER_PIN)){
ZenDrive.setBlinkerRight(false); ZenDrive.setBlinkerLeft(true);
} ZenDrive.setBlinkerRight(false);
else if(digitalRead(RIGHT_BLINKER_PIN)){ }
ZenDrive.setBlinkerLeft(false); else if(digitalRead(RIGHT_BLINKER_PIN)){
ZenDrive.setBlinkerRight(true); ZenDrive.setBlinkerLeft(false);
} ZenDrive.setBlinkerRight(true);
else{ }
ZenDrive.setBlinkerLeft(false); else{
ZenDrive.setBlinkerRight(false); ZenDrive.setBlinkerLeft(false);
} ZenDrive.setBlinkerRight(false);
// Right blinker }
ZenDrive.setBlinkerRight(digitalRead(RIGHT_BLINKER_PIN)); // Right blinker
// Warning ZenDrive.setBlinkerRight(digitalRead(RIGHT_BLINKER_PIN));
ZenDrive.setWarning(digitalRead(WARNING_PIN)); // Warning
// Lights ZenDrive.setWarning(digitalRead(WARNING_PIN));
if (!digitalRead(LIGHTS_ON_PIN)) ZenDrive.switchLightsOn(); // Lights
else if(!digitalRead(ROAD_LIGHTS_PIN)) ZenDrive.switchRoadLights(); if (!digitalRead(LIGHTS_ON_PIN)) ZenDrive.switchLightsOn();
else ZenDrive.switchLightsOff(); else if(!digitalRead(ROAD_LIGHTS_PIN)) ZenDrive.switchRoadLights();
// Head lights else ZenDrive.switchLightsOff();
ZenDrive.setHeadLights(digitalRead(HEAD_LIGHTS_PIN)); // Head lights
// Fog lights ZenDrive.setHeadLights(digitalRead(HEAD_LIGHTS_PIN));
ZenDrive.setFogLights(digitalRead(FOG_LIGHTS_PIN)); // Fog lights
// Starter ZenDrive.setFogLights(digitalRead(FOG_LIGHTS_PIN));
ZenDrive.setStarter(digitalRead(STARTER_PIN)); // Starter
// Read direction ZenDrive.setStarter(digitalRead(STARTER_PIN));
ZenDrive.setDirection(map(analogRead(DIRECTION_PIN), 0, 1023, -127, 127)); // Read direction
ZenDrive.sendWheelStates(); ZenDrive.setDirection(map(analogRead(DIRECTION_PIN), 0, 1023, -127, 127));
ZenDrive.sendWheelStates();
}
} }
void loop() { void loop() {
@@ -115,59 +124,72 @@ void loop() {
ZenDrive.wheelNeedRefresh = false; ZenDrive.wheelNeedRefresh = false;
/* Gearshift module */ /* Gearshift module */
//Read speed states on the analog shared pin if(USE_GEARSHIFT){
int value = analogRead(SPEEDS_PIN); //Read speed states on the analog shared pin
if(value < 200) ZenDrive.switchSpeed1(); int value = analogRead(SPEEDS_PIN);
else if(value < 326) ZenDrive.switchSpeed2(); if(value < 200) ZenDrive.switchSpeed1();
else if(value < 421) ZenDrive.switchSpeed3(); else if(value < 326) ZenDrive.switchSpeed2();
else if(value < 493) ZenDrive.switchSpeed4(); else if(value < 421) ZenDrive.switchSpeed3();
else if(value < 551) ZenDrive.switchSpeed5(); else if(value < 493) ZenDrive.switchSpeed4();
else if(value < 596) ZenDrive.switchSpeed6(); else if(value < 551) ZenDrive.switchSpeed5();
else if(value < 634) ZenDrive.switchSpeedR(); else if(value < 596) ZenDrive.switchSpeed6();
else ZenDrive.switchNeutral(); else if(value < 634) ZenDrive.switchSpeedR();
//Read handbrake else ZenDrive.switchNeutral();
ZenDrive.setHandbrake(map(analogRead(HANDBRAKE_PIN), 0, 1023, 0, 255)); //Read handbrake
// Send gearshift states if there are changes ZenDrive.setHandbrake(map(analogRead(HANDBRAKE_PIN), 0, 1023, 0, 255));
if(ZenDrive.gearshiftNeedRefresh) ZenDrive.sendGearshiftStates(); // Send gearshift states if there are changes
if(ZenDrive.gearshiftNeedRefresh) ZenDrive.sendGearshiftStates();
}
/* Pedals module */ /* Pedals module */
// Read clutch if(USE_PEDALS){
ZenDrive.setClutch(map(analogRead(CLUTCH_PIN), 0, 1023, 0, 255)); // Read clutch
// Read brake ZenDrive.setClutch(map(analogRead(CLUTCH_PIN), 0, 1023, 0, 255));
ZenDrive.setBrake(map(analogRead(BRAKE_PIN), 0, 1023, 0, 255)); // Read brake
// Read accelerator ZenDrive.setBrake(map(analogRead(BRAKE_PIN), 0, 1023, 0, 255));
ZenDrive.setAccelerator(map(analogRead(ACCELERATOR_PIN), 0, 1023, 0, 255)); // Read accelerator
// Send pedals states if they are changes ZenDrive.setAccelerator(map(analogRead(ACCELERATOR_PIN), 0, 1023, 0, 255));
if(ZenDrive.pedalsNeedRefresh) ZenDrive.sendPedalsStates(); // Send pedals states if they are changes
if(ZenDrive.pedalsNeedRefresh) ZenDrive.sendPedalsStates();
}
/* Steering wheel module */ /* Steering wheel module */
// Left blinker if(USE_WHEEL){
ZenDrive.setBlinkerLeft(digitalRead(LEFT_BLINKER_PIN)); // Blinkers
// Right blinker if(digitalRead(LEFT_BLINKER_PIN)){
ZenDrive.setBlinkerRight(digitalRead(RIGHT_BLINKER_PIN)); ZenDrive.setBlinkerLeft(true);
// Warning ZenDrive.setBlinkerRight(false);
ZenDrive.setWarning(digitalRead(WARNING_PIN)); }
// Lights else if(digitalRead(RIGHT_BLINKER_PIN)){
if (!digitalRead(LIGHTS_ON_PIN)) ZenDrive.switchLightsOn(); ZenDrive.setBlinkerLeft(false);
else if(!digitalRead(ROAD_LIGHTS_PIN)) ZenDrive.switchRoadLights(); ZenDrive.setBlinkerRight(true);
else ZenDrive.switchLightsOff(); }
// Head lights else{
ZenDrive.setHeadLights(digitalRead(HEAD_LIGHTS_PIN)); ZenDrive.setBlinkerLeft(false);
// Fog lights ZenDrive.setBlinkerRight(false);
ZenDrive.setFogLights(digitalRead(FOG_LIGHTS_PIN)); }
// Starter // Warning
ZenDrive.setStarter(digitalRead(STARTER_PIN)); ZenDrive.setWarning(digitalRead(WARNING_PIN));
// Horn // Lights
ZenDrive.setHorn(!digitalRead(HORN_PIN)); if (!digitalRead(LIGHTS_ON_PIN)) ZenDrive.switchLightsOn();
// Cruise on else if(!digitalRead(ROAD_LIGHTS_PIN)) ZenDrive.switchRoadLights();
if(!digitalRead(CRUISE_PIN)) ZenDrive.activeCruise(); else ZenDrive.switchLightsOff();
// Cruise up // Head lights
if(!digitalRead(CRUISE_UP_PIN)) ZenDrive.increaseCruise(); ZenDrive.setHeadLights(digitalRead(HEAD_LIGHTS_PIN));
// Cruise down // Fog lights
if(!digitalRead(CRUISE_DOWN_PIN)) ZenDrive.decreaseCruise(); ZenDrive.setFogLights(digitalRead(FOG_LIGHTS_PIN));
// Read direction // Starter
ZenDrive.setDirection(map(analogRead(DIRECTION_PIN), 0, 1023, -127, 127)); ZenDrive.setStarter(digitalRead(STARTER_PIN));
// Send steering wheel states if they are changes // Horn
if(ZenDrive.wheelNeedRefresh) ZenDrive.sendWheelStates(); ZenDrive.setHorn(!digitalRead(HORN_PIN));
// Cruise on
if(!digitalRead(CRUISE_PIN)) ZenDrive.activeCruise();
// Cruise up
if(!digitalRead(CRUISE_UP_PIN)) ZenDrive.increaseCruise();
// Cruise down
if(!digitalRead(CRUISE_DOWN_PIN)) ZenDrive.decreaseCruise();
// Read direction
ZenDrive.setDirection(map(analogRead(DIRECTION_PIN), 0, 1023, -127, 127));
// Send steering wheel states if they are changes
if(ZenDrive.wheelNeedRefresh) ZenDrive.sendWheelStates();
}
delay(50); delay(50);
} }