Further testing..

Communication fixed, reading sensors still broken...