Code redesign for sensor updates and added GPS logging