제네시스 쿠페 2.0 블루투스 핸들

/*
Genesis Coupe, C2Port 5pin, Voltage Divider (2*150k, so half the ref voltage;5V) 
Normal 2900
SeekUp 130
SeekDn 450
VolUp 1380
VolDn 1680
Mode 810
Call 2590
HangUp 2300
*/


#include <BleKeyboard.h>

BleKeyboard bleKeyboard;

const int stBtn = 4; //Analog GPIO
const int seekUp = 130; //Next Track
const int seekDn = 450; //Prev Track
const int hangUp = 2300; //Hang-Up
const int normal = 2900; //Not Pressed
const int btnMargin = 100;

unsigned long lastDebounceTime = 0;  
unsigned long debounceDelay = 10;
unsigned long sampleTime = 0;
unsigned long sampleTimeDelay = 3;

int btnRead = normal;
int rawBtnRead = normal;
int rawBtnState = 0;
int lastRawBtnState = 0; 
int btnState = 0;


void setup() {
  Serial.begin(115200);
  Serial.println("Starting BLE work!
");
  bleKeyboard.setName("BK MediaControl BLE");
  bleKeyboard.begin();
  pinMode(stBtn, INPUT);  
}

void loop() {
  if(bleKeyboard.isConnected()) {
    if(millis() > sampleTime + sampleTimeDelay){
      btnRead = analogRead(stBtn);

      Serial.print("Filtered Analog Val: ");
      Serial.print(btnRead);
      Serial.print(" Current Button State: ");
      Serial.println(btnState);

      if(((seekUp-btnMargin)<btnRead) && (btnRead<(seekUp+btnMargin))){
        rawBtnState=1;
      }
      else if(((seekDn-btnMargin)<btnRead) && (btnRead<(seekDn+btnMargin))){
        rawBtnState=2;
      }
      else if(((hangUp-btnMargin)<btnRead) && (btnRead<(hangUp+btnMargin))){
        rawBtnState=3;
      }
      else{
        rawBtnState=0;
      }

      sampleTime = millis();
    }

    if (rawBtnState !
= lastRawBtnState) {
      lastDebounceTime = millis();
    }

    if ((millis() - lastDebounceTime) > debounceDelay) {
      if(rawBtnState==0) {
        if(btnState==1){
          bleKeyboard.write(KEY_MEDIA_NEXT_TRACK);
        }
        else if(btnState==2){
          bleKeyboard.write(KEY_MEDIA_PREVIOUS_TRACK);
        }
        else if(btnState==3){
          bleKeyboard.write(KEY_MEDIA_PLAY_PAUSE);
        }
      }
      
      btnState=rawBtnState;
    }

    lastRawBtnState = rawBtnState;
  }
}