FIRST Robotics Competition 2017, Team 6353's robot code
The gyro System had not been tested.
· Climb the rope
· Drive with joy stick
· get gyo status (used in auto mode)
Deliver gear when we are at no.2 start place.
Simply drive over the line when at no.1 or 3 start place.
All the ports and buttons' function are set in RobotMap.java