fixed robot debug part
PWM hack works in that it increases frequency. I2C breaks everything. Added robot debug code which will just print everything it gets from i2c... hopefully