#include <EButton.h>
#include <LiquidCrystal_I2C.h>

EButton button(2);
LiquidCrystal_I2C lcd(0x27, 20, 4);
unsigned long start;
unsigned long elapsed;
unsigned long history[3];
bool oddClick = true;


uint8_t extract(unsigned long& time, uint8_t const part) {
  uint8_t result = time % part;
  time /= part;
  return result;
}

void format(char buffer[], unsigned long const time) {
  if (not time) {
    buffer[0] = 0;
    return;
  }
  
  unsigned long time_ = time / 100;
  uint8_t tenths = extract(time_, 10);
  uint8_t seconds = extract(time_, 60);
  uint8_t minutes = extract(time_, 60);
  uint8_t hours = extract(time_, 60);
  sprintf(buffer, "%02i:%02i:%02i:%i", hours, minutes, seconds, tenths);
}

void click(EButton&) {
  static size_t index = 0;

  oddClick = not oddClick;
  if (oddClick) {
    return;
  }

  history[index] = elapsed;
  index = (index + 1) % 3;
  start = millis();

  for (size_t i = 0; i < 3; i++) {
    char buffer[11];
    format(buffer, history[(index + 2 - i) % 3]);
    lcd.setCursor(0, i + 1);
    lcd.print(buffer);
  }
}


void setup() {
  Serial.begin(9600);

  lcd.init();
  lcd.backlight();

  button.attachSingleClick(click);
}

void loop() {
  if (not oddClick) {
    elapsed = millis() - start;
  
    char buffer[11];
    format(buffer, elapsed);
    lcd.setCursor(0, 0);
    lcd.print(buffer);
  }
  button.tick();
}
mega:SCL
mega:SDA
mega:AREF
mega:GND.1
mega:13
mega:12
mega:11
mega:10
mega:9
mega:8
mega:7
mega:6
mega:5
mega:4
mega:3
mega:2
mega:1
mega:0
mega:14
mega:15
mega:16
mega:17
mega:18
mega:19
mega:20
mega:21
mega:5V.1
mega:5V.2
mega:22
mega:23
mega:24
mega:25
mega:26
mega:27
mega:28
mega:29
mega:30
mega:31
mega:32
mega:33
mega:34
mega:35
mega:36
mega:37
mega:38
mega:39
mega:40
mega:41
mega:42
mega:43
mega:44
mega:45
mega:46
mega:47
mega:48
mega:49
mega:50
mega:51
mega:52
mega:53
mega:GND.4
mega:GND.5
mega:IOREF
mega:RESET
mega:3.3V
mega:5V
mega:GND.2
mega:GND.3
mega:VIN
mega:A0
mega:A1
mega:A2
mega:A3
mega:A4
mega:A5
mega:A6
mega:A7
mega:A8
mega:A9
mega:A10
mega:A11
mega:A12
mega:A13
mega:A14
mega:A15
btn1:1.l
btn1:2.l
btn1:1.r
btn1:2.r
lcd1:GND
lcd1:VCC
lcd1:SDA
lcd1:SCL