fixed some hardware mapping issues, fixed teleop