   Wire.begin(I2C_ADDRESS);
   Wire.onReceive(receiveEvent);
   Wire.onRequest(requestEvent);
-  lcd.begin();
-  lcd.clear_screen();
-  lcd.set_brightness(0x77);
-  lcd.set_cursor(0, 5);
-  lcd.print("Pathfinder");
 }
 
-// Display Reference
-// 0  1  2  3  4  5  6  7  8  9  10 11 12 13 14 15 16 17 18 19
-//                   P  a  t  h  f  i  n  d  e  r
-// M  1  :     F  0  5  5     M  2  :     R  0  5  5
-//
-// L  :  0  5  5     F  :  0  5  5     R  :  0  5  5
 void loop()
 {
   struct Event e;

// Remember to use Arduino pins, not physical ones
Motor motor1 = Motor(2, 3);
Motor motor2 = Motor(4, 5);
volatile byte sensor_left, sensor_front, sensor_right;
RingBufCPP<struct Event, MAX_NUM_ELEMENTS> buf;

void setup()

#include <Wire.h>
#include <RingBufCPP.h>
#include "Motor.h"

#define I2C_ADDRESS 0x1A
#define I2C_BUFFER_SIZE 32
#define MAX_NUM_ELEMENTS 30
#define MOTOR1_ADDRESS 0x01
#define MOTOR2_ADDRESS 0x02

char i2c_buffer[I2C_BUFFER_SIZE];

struct Event
