Arduino Controlled PSE Pump Code

From W220 S-Class Encyclopedia
Revision as of 05:44, 17 August 2020 by Joshuarjs (talk | contribs)
Jump to navigation Jump to search

This is the code for the Arduino Controlled PSE Pump.

/*
 Code for controlling the Mercedes W220 PSE with an Arduino
*/
 
 // Assign Remote Control Pins
static const int RemA = 10; //A
static const int RemB = 11; //B
static const int RemC = 12; //C
static const int RemD = 13; //D

// Assign PSE Pressure Sensor Pin
static const int PPin = A0;

// Assign Trunk Lid Switch Pin
static const int TPin = A1;
int TrunkPrevState;

// Assign Relay Pins
static const int RelMotor =  2;
static const int RelPos =  3;
static const int RelNeg =  4;
static const int RelFLDr =  5;
static const int RelDrs =  6;
static const int RelTrunk =  8;
static const int RelHR =  9;
static const int RelTrunkSol =  7;

// Double Click Variables
int ButtonAState;
unsigned long timePress = 0;
unsigned long timePressLimit = 0;
int clicks = 0;

// Long Press Variables
long buttonTimer = 0;
long longPressTime = 1000;
boolean buttonActive = false;
boolean longPressActive = false;

// Assign Arduino Auto Shutdown Relay Pin
static const int SPin = A2;

// Timer Variable for Auto Shutdown
unsigned long time;
unsigned long timeout = 14400000; //4 hours

//--------------------------------------------------------------------------------------------------------

void setup() {

  // Define pin modes
  pinMode(PPin, INPUT);
  pinMode(TPin, INPUT_PULLUP);
  pinMode(SPin, OUTPUT);

  pinMode(RelMotor, OUTPUT);
  pinMode(RelPos, OUTPUT);
  pinMode(RelNeg, OUTPUT);
  pinMode(RelFLDr, OUTPUT);
  pinMode(RelDrs, OUTPUT);
  pinMode(RelTrunk, OUTPUT);
  pinMode(RelHR, OUTPUT);
  pinMode(RelTrunkSol, OUTPUT);

  pinMode(RemA, INPUT);
  pinMode(RemB, INPUT);
  pinMode(RemC, INPUT);
  pinMode(RemD, INPUT);

  // Making sure all relays are OFF
  digitalWrite(RelMotor, HIGH);
  digitalWrite(RelPos, HIGH);
  digitalWrite(RelNeg, HIGH);
  digitalWrite(RelFLDr, HIGH);
  digitalWrite(RelDrs, HIGH);
  digitalWrite(RelTrunk, HIGH);
  digitalWrite(RelHR, HIGH);
  digitalWrite(RelTrunkSol, HIGH);
  digitalWrite(SPin, HIGH);

  // Read trunk's current state
  TrunkPrevState = digitalRead(TPin);
}

//--------------------------------------------------------------------------------------------------------

void loop() {

// Auto Shutdown Timer--------------------------------------------------------------
  time = millis(); // Time elapsed since Arduino started
  if (time > timeout && digitalRead(TPin) == HIGH)
  {
    //Turn off Arduino if trunk is and was closed. Else add 30 seconds to the timer.
    if (TrunkPrevState == HIGH && digitalRead(TPin) == HIGH)
    {
      digitalWrite(SPin, LOW);
    }
    else
    {
      timeout = timeout + 30000;
    }
  }

// Button A pressed --------------------------------------------------------------
  if (digitalRead(RemA) == HIGH) 
  {
    LockAll();
  }

// Button B pressed once or twice-------------------------------------------------
// Credit - The_Little_Cousin : https://forum.arduino.cc/index.php?topic=425587.msg2932300#msg2932300
  if (digitalRead(RemB) == HIGH) {
    delay(100);
    if (digitalRead(RemB) == LOW) {
      if (clicks == 0) {
        timePress = millis();
        timePressLimit = timePress + 1000;
        clicks = 1;
      }
      else if (clicks == 1 && millis() < timePressLimit) {
        //Double press action
        UnlockAll();

        //Set variables back to 0
        timePress = 0;
        timePressLimit = 0;
        clicks = 0;
      }
    }
  }
  //Single press
  if (clicks == 1 && timePressLimit != 0 && millis() > timePressLimit)
  {
    timePress = 0;
    timePressLimit = 0;
    clicks = 0;

    //Single press action
    UnlockDriver();
  }



// Button C long-pressed --------------------------------------------------------------
// Credit xn1ch1 : https://www.instructables.com/id/Arduino-Dual-Function-Button-Long-PressShort-Press/
  if (digitalRead(RemC) == HIGH)
  {
    if (buttonActive == false) {
      buttonActive = true;
      buttonTimer = millis();
    }
    if ((millis() - buttonTimer > longPressTime) && (longPressActive == false)) {
      longPressActive = true;
      //Long-press action - Unlock the trunk
      UnlockTrunk();
    }
  } 
  else {
    if (buttonActive == true) {
      if (longPressActive == true) {
        longPressActive = false;
      } else {
        //Short-press action - Nothing
      }
      buttonActive = false;
    }
  }


// Button D pressed --------------------------------------------------------------
  if (digitalRead(RemD) == HIGH)
  {
    DropHeadRest();
  }



// Trunk lid closed -----------------------------------------------------------------
// When the trunk state changes from open(LOW) to closed (HIGH)
  if (TrunkPrevState == LOW && digitalRead(TPin) == HIGH)
  {
    LockTrunk();
  }

  // Store current trunk state
  TrunkPrevState = digitalRead(TPin);

}



//--------------------------------------------------------------------------------------------------------

void LockAll()

/*
  Lock car with +ve pressure, which pulls the Door Lock Button down, then returns to atmospheric press
*/
{
  // Doors are locked in 2 steps since there's not enough pressure. Possibly due to a small leak.
  //+ve Pressure
    digitalWrite(RelPos, LOW);
    digitalWrite(RelNeg, HIGH);
  //Driver Door
    digitalWrite(RelFLDr, LOW);
      MotorRun(3);
    digitalWrite(RelFLDr, HIGH);
  //Remaining Doors
    digitalWrite(RelDrs, LOW);
      MotorRun(5);
    digitalWrite(RelDrs, HIGH);
  //Release Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, HIGH);
  delay (100);
}

//--------------------------------------------------------------------------------------------------------

void UnlockAll()
/*
  Unlock car with -ve pressure , which moves Door Lock Button up, then returns to atmospheric pressure.
*/
{
  // Doors are locked in 2 steps since there's not enough pressure. Possibly due to a small leak.
  //-ve Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, LOW);
  //Passenger Doors
    digitalWrite(RelDrs, LOW);
      MotorRun(6);
    digitalWrite(RelDrs, HIGH);
  //Driver Door
   digitalWrite(RelFLDr, LOW);
      MotorRun(3);
    digitalWrite(RelFLDr, HIGH);
  //Release Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, HIGH);
  delay (100);
}

//--------------------------------------------------------------------------------------------------------

void UnlockDriver()
/*
  Unlock car with -ve pressure , which moves Driver Door Lock Button up, then returns to atmospheric pressure.
*/
{
  //-ve Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, LOW);
  //Driver Door
   digitalWrite(RelFLDr, LOW);
      MotorRun(3);
    digitalWrite(RelFLDr, HIGH);
  //Release Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, HIGH);
  delay (100);
}

//--------------------------------------------------------------------------------------------------------

void DropHeadRest()
/*
  Drop rear headrests with -ve pressure.
*/
{
  //-ve Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, LOW);
  //Rear Seat Head Restraints
    digitalWrite(RelHR, LOW);
      MotorRun(3);
    digitalWrite(RelHR, HIGH);
  //Release Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, HIGH);
  delay (100);
}


//--------------------------------------------------------------------------------------------------------

void LockTrunk()
/*
   Manually close Boot/Trunk by pulling down on RTG Handle until latch goes click,
   1) +ve pressure, Boot/Trunk Catch Actuator pulls boot closed,
   2) –ve pressure, retracts the Retractable Trunklid Grip (RTG) Handle,
   3) Returns to atmospheric pressure.
*/
{
  // Open PSE Trunk HECK valve
    digitalWrite(RelTrunk, LOW);
  //+ve Pressure
    digitalWrite(RelPos, LOW);
    digitalWrite(RelNeg, HIGH);
  //Trunk Catch Actuator pulls boot closed
    MotorRun(7);
  //-ve Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, LOW);
  // Retract RTG Handle
    MotorRun(4);
  // Close PSE Trunk HECK valve
    digitalWrite(RelTrunk, HIGH);
  //Release Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, HIGH);
  delay (100);
}


//--------------------------------------------------------------------------------------------------------

void UnlockTrunk()
/*
   Open Boot/Trunk with trunk latch solenoid and +ve pressure, which
   extends RTG Handle, and unlocks Boot/Trunk latch, releasing lid 
   which fully opens, then returns to atmospheric pressure.
*/
{
  //+ve Pressure
    digitalWrite(RelPos, LOW);
    digitalWrite(RelNeg, HIGH);
  // Open PSE Trunk HECK valve
    digitalWrite(RelTrunk, LOW);
  // Open Solenoid Valve in trunk lock
    digitalWrite(RelTrunkSol, LOW);
  // Open Boot/Trunk latch
    MotorRun(1.5);
  // Close Solenoid Valve in trunk lock
    digitalWrite(RelTrunkSol, HIGH);
  // Extend RTG Handle
    MotorRun(4);
  // Close PSE Trunk HECK valve
    digitalWrite(RelTrunk, HIGH);
  //Release Pressure
    digitalWrite(RelPos, HIGH);
    digitalWrite(RelNeg, HIGH);
  delay (100);
}


//--------------------------------------------------------------------------------------------------------

void MotorRun(float t)
/* Turns on motor relay for t seconds
   Checks PPin for pressure extremes every 100ms and turns off motor if out of bounds.
*/
{
  int pressure;
  delay (100);
  
  //Start the motor
  digitalWrite(RelMotor, LOW);

  for (int i = 0; i <= (t * 10); i++) // t is converted from sec to multiples of 100ms (delay below)
  {
    pressure = analogRead(PPin);
    if (i > 10)  // Only check after 1 sec has passed to ignore spikes at startup
    {
      if (pressure < 80 || pressure > 640)
      {
        // Immediately stop motor and exit function
        digitalWrite(RelMotor, HIGH);
        delay (100);
        return;
      }
      else
      {
        delay (100); //Wait and recheck
      }
    }
  }
  // Stop the motor after t secs have passed
  digitalWrite(RelMotor, HIGH);
  delay (100);
}

//--------------------------------------------------------------------------------------------------------