Combine Servo with dual switch for controlling blinds

[reallifeonhold]

I've setup a few sensors/nodes and have been successfully using the Servo sketch for controlling a set of blinds (tilt only). What I would like to do is add a physical wall switch that would also control the motion of the blinds to mimic that of the virtual switch in the controller software. e.g., if UP is pushed and held on the switch, the blinds would open and if DOWN is pushed and held, they would close. As soon as either button is released, the blinds would stop in that position.

I've already modified a basic Decora light switch by replacing the internals with (2) momentary switches, effectively turning it into a ON-OFF-ON toggle switch.

I figured this would be relatively straightforward on the code side but I'm not sure how to integrate the button control to work with the commands in the MySensors library.

Basic Arduino code for a standalone switch setup would be as follows:

#include <Servo.h>

const int buttonPin1 = 2;
const int buttonPin2 = 4;

int buttonState1 = 0;
int buttonState2 = 0;

Servo myservo;

int position = 0;

void setup() {

myservo.attach(3);
pinMode(buttonPin1, INPUT);
pinMode(buttonPin2,INPUT);
}

void loop() {

buttonState1 = digitalRead(buttonPin1);
buttonState2 = digitalRead(buttonPin2);

if(buttonState1 == HIGH && position < 180){
myservo.write(position++);
delay(5);
}

if(buttonState2 == HIGH && position > 3){
myservo.write(position--);
delay(5);
}
}

And, for reference, here's the current code that controls the servo in the blinds:

/**
 * The MySensors Arduino library handles the wireless radio link and protocol
 * between your home built sensors/actuators and HA controller of choice.
 * The sensors forms a self healing radio network with optional repeaters. Each
 * repeater and gateway builds a routing tables in EEPROM which keeps track of the
 * network topology allowing messages to be routed to nodes.
 *
 * Created by Henrik Ekblad <henrik.ekblad@mysensors.org>
 * Copyright (C) 2013-2015 Sensnology AB
 * Full contributor list: https://github.com/mysensors/Arduino/graphs/contributors
 *
 * Documentation: http://www.mysensors.org
 * Support Forum: http://forum.mysensors.org
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 as published by the Free Software Foundation.
 *
 *******************************
 *
 * REVISION HISTORY
 * Version 1.0 - Henrik Ekblad
 * Contribution by: Derek Macias
 * 
 * DESCRIPTION
 * Example showing how to create an atuator for a servo.
 * Connect red to +5V, Black or brown to GND and the last cable to Digital pin 3.
 * The servo consumes much power and should probably have its own powersource.'
 * The arduino might spontanally restart if too much power is used (happend
 * to me when servo tried to pass the extreme positions = full load).
 * http://www.mysensors.org/build/servo
 */

// Enable debug prints to serial monitor
#define MY_DEBUG 

// Enable and select radio type attached
#define MY_RADIO_NRF24
//#define MY_RADIO_RFM69

#include <SPI.h>
#include <MySensors.h>
#include <Servo.h> 

#define SERVO_DIGITAL_OUT_PIN 3
#define SERVO_MIN 0 // Fine tune your servos min. 0-180
#define SERVO_MAX 180  // Fine tune your servos max. 0-180
#define DETACH_DELAY 900 // Tune this to let your movement finish before detaching the servo
#define CHILD_ID 8   // Id of the sensor child



MyMessage msg(CHILD_ID, V_DIMMER);
Servo myservo;  // create servo object to control a servo 
                // a maximum of eight servo objects can be created Sensor gw(9,10);
unsigned long timeOfLastChange = 0;
bool attachedServo = false;
            
void setup() 
{ 
  // Request last servo state at startup
  request(CHILD_ID, V_DIMMER);
} 

void presentation()  {
  // Send the sketch version information to the gateway and Controller
  sendSketchInfo("Servo", "1.0");

  // Register all sensors to gw (they will be created as child devices)
  present(CHILD_ID, S_COVER);
}

void loop() 
{ 
  if (attachedServo && millis() - timeOfLastChange > DETACH_DELAY) {
     myservo.detach();
     attachedServo = false;
  }
} 

void receive(const MyMessage &message) {
  myservo.attach(SERVO_DIGITAL_OUT_PIN);   
  attachedServo = true;
  if (message.type==V_DIMMER) { // This could be M_ACK_VARIABLE or M_SET_VARIABLE
     int val = message.getInt();
     val = map(val, 0, 100, 180, 0); // scale 0%-100% between 0 and 180)
    myservo.write(val);       // sets the servo position 0-180
     
     // myservo.write(SERVO_MAX + (SERVO_MIN-SERVO_MAX)/100 * val); // sets the servo position 0-180
     // Write some debug info
     Serial.print("Servo changed. new state: ");
     Serial.println(val);
   } else if (message.type==V_UP) {
     Serial.println("Servo UP command");
     myservo.write(SERVO_MIN);
     send(msg.set(100));
   } else if (message.type==V_DOWN) {
     Serial.println("Servo DOWN command");
     myservo.write(SERVO_MAX); 
     send(msg.set(0));
   } else if (message.type==V_STOP) {
     Serial.println("Servo STOP command");
     myservo.detach();
     attachedServo = false;

   }
   timeOfLastChange = millis();
}

Thanks in advance for any help/guidance!