All sensors functional. Added initialization and configuration of full MPU/Compass unit. Added some I2C functions to assist with reading/writing. Replace old screen usage for python script to watch serial port.