#include <wiringPi.h>
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>

char currentVolume;
int digiPot;

void volumeUp(void) {
    setLVolume(++currentVolume);
    setRVolume(currentVolume);
}

void volumeDown(void) {
    setLVolume(--currentVolume);
    setRVolume(currentVolume);
}

void setLVolume(char Volume) {
  wiringPiI2CWrite(digiPot, Volume & 0x3F);
}
void setRVolume(char Volume) {
  wiringPiI2CWrite(digiPot, (Volume & 0x3F) | 0x40);
}

void init(void) {
  // Setup the PWM to generate the -5V rail for the digipot
  pinMode(18,PWM_OUTPUT);
  pwmSetMode(PWM_MODE_MS);
  pwmSetClock(512); // 512 = 17.5kHz, 256 = 35kHz, 128 = 70kHz, 64 = 140kHz
  pwmSetRange(2);
  pwmWrite (18, 1);

  // Enable the volume control
  pinMode(27,OUTPUT);
  digitalWrite(27,LOW);

  // Setup the push buttons
  // Up
  pinMode(22,INPUT);
  pullUpDnControl(22,PUD_UP);
  wirintPiISR(22, INT_EDGE_FALLING, &volumeUp);

  // Down
  pinMode(23,INPUT);
  pullUpDnControl(23,PUD_UP);
  wirintPiISR(23, INT_EDGE_FALLING, &volumeDown);

  // Setup I2C to talk to the digipot
  digiPot = wiringPiI2CSetup(0x50);

  // Set the volume to about 30% on startup
  currentVolume = 10;
  setLVolume(currentVolume);
  setRVolume(currentVolume);


  // Any extra init code can go here
}

void loop(void) {
    delay(1000);

    // You can add code here if required, run once per second
}

int main (void)
{
  if (wiringPiSetupGpio() == -1)
    exit (1) ;

  init();

  for (;;) loop();
}