Added Gyro and now using Gyro derived heading instead of odometry derived heading