changed to port 3
added accelerometer and gyro
testing SMUX - compiles, but not yet on robot.