SMUX Testing success

Changed readCal to readRot for gyro, I'll just have to take the integral
of the degrees/second to get degrees. Also, every sensor worked as
expected!