Added/fixed buttons to control winch
Adjusted RobotMap
Added constants