-Added some SmartDashboard outputs and println's for the offsets