2011:Autonomous

Autonomous Actions

We split it up into three stages:
1. Starting Positions and Actions (Approach the pegs)
2. Peg Height (Put Ubertube on pegs)
3. Ending action.

To tell the robot which set of actions to perform you select an autonomous mode using the classmate or a paper handbook, which tells you three numbers that you plug in using a keypad on the driver’s station. The robot understands and runs based on the numbers. (Example 000 tells the robot to do nothing during autonomous).

Start Positions and Actions

Start Positions and Actions:	0 Do nothing
Peg Height:	0 Do Nothing	1 Top Peg (Normal Height)	2 Middle peg (Normal Height)	3 Low peg (Normal Height)
	Go to -> Ending Action

Start Positions and Actions:	1 Follow straight line (Left side) and 2 Follow straight line (Right side)
Peg Height:	0 Do Nothing	1 Top Peg (Normal Height)	2 Middle peg (Normal Height)	3 Low peg (Normal Height)
		Drive Forward 245? inches on line [be far enough away from pegs to move arm without hitting pegs] While driving: Move arm to middle peg position [do not twist tube]
		Have manip. twist tube to top peg angle Move arm to top peg Drive Forward 30? inches	Have manip. twist tube to middle peg angle arm doesn't move Drive Forward 24? inches	Have manip. twist tube to low peg angle Move arm to low peg Drive forward 28? inches
	Eject tube Back up same amount we drove forward Go to -> Ending Action

Start Positions and Actions:	3 Follow center line (Left fork) and 4 Follow center line (Right fork)
Peg Height:	0 Do Nothing	1 Top Peg (Normal Height)	2 Middle peg (Normal Height)	3 Low peg (Normal Height)
		Go foward to fork (while raising arm to middle peg offset.) drive slightly more (to no longer see line, half the robot distance so we can turn correctly(19? inches)) Turn left/right until line is visible.
		Tell Manip to angle tube to top peg positon Raise arm to top peg height Drive forward (while following line) 60 inches Turn 28?/-28? degrees Go forward 24? inches	Tell Manip. to angle tube to middle peg positon. Raise arm to middle peg height  Drive forward (while following line) 60 inches Turn 30?/-30? degrees Go forward 36? inches	Tell manipulator to angle tube to low peg position. Raise arm to low peg height Drive forward (while following line) 60 inches Turn 29?/-29? degrees Go forward 34? inches
		Eject tube Back up (Same distance as last drive forward) if right fork: turn -(60 + same angle as last turn) degrees if left fork: turn -(-60 + same angle as last turn) degrees Go to -> Ending Action

Ending Actions

Ending Action:	0 Do Nothing	1 Stay at pegs don't turn (do nothing #  2)	2 Stay at pegs (turn 180)	3 Drive backwards to midfield	4 Drive Backwards to midfield and turn 180	5 Drive to lane
		Raise arm to max height
			Turn 180 degrees	Drive forward -245 inches.	Drive forward -245 inches Turn 180 degrees
	Stop all motors Wait for Teleoperated mode Go to -> Teleoperated mode

Dead Reckoning

Start Positions and Actions:	Dead Reckoning offset pegs
Peg Height:	0 Do Nothing	1 Top Peg (Offset Height)	2 Middle peg (Offset Height)	3 Low peg (Offset Height)
		Drive Forward 245? inches Raise arm to middle peg positon (while driving)
		Move arm to top peg offset height Have Manip. angle tube for top peg offset height Drive forward 36 inches	Move arm to middle peg offset height Have Manip. angle tube for middle peg offset height Drive forward 24 inches	Move arm to low peg offset height Have Manip. angle tube for low peg offset height  Drive forward 30 inches
	Eject tube Back up same amount we drove forward Go to -> Ending Action

Start Positions and Actions:	Dead Reckoning
Peg Height:	0 Do Nothing	1 Top Peg (Normal Height)	2 Middle peg (Normal Height)	3 Low peg (Normal Height)
		Drive Forward 245? inches Raise arm to middle peg positon (while driving)
		Move arm to top peg height Have Manip. angle tube for top peg height Drive forward 36 inches	Move arm to middle peg height Have Manip. angle tube for middle peg height Drive forward 24 inches	Move arm to low peg height Have Manip. angle tube for low peg height  Drive forward 30 inches
	Eject tube Back up same amount we drove forward Go to -> Ending Action

Approach pegs

Strategy 5

Dead Reckoning (Striaght line)

1.) Drive Forward 244.9 inches

1.5.) Raise arm to middle peg position

1.5.5)Turn manipulator belts to positon tube for placement

2.) Go to -> Ubertube Placement

Strategy 6
Dead Reckoning (Center Line Left fork)

1.) Drive Forward 157.3 inches

1.5.) Raise arm to middle peg position

2.) Turn 35deg Counterclockwise

3.) Drive forward 67.5 inches

4.) Turn 35deg Clockwise

5.) Go to -> Place Ubertube

Strategy 7
Dead Reckoning (Center Line right fork)

1.) Drive Forward 157.3 inches

1.5.) Raise arm to middle peg position

2.) Turn 35deg clockwise

3.) Drive forward 67.5 inches

4.) Turn 35deg CounterClockwise

5.) Go to -> Place Ubertube

Stage 2: Ubertube Placement

Stage 3: Final Action

Strategy 3
Go to midfield while driving backwards

1.) Drive forward -245 inches

2.) Stop all motors

3.) Wait for teleoperated mode

4.) Go to -> Teleoperated mode

Strategy 4
Drive to midfield backwards, then turn!

1.) Drive forward -245 inches

2.) Turn 180 deg

3.) Stop all motors

4.) Wait for Teleoperated mode

5.) Go to -> Teleoperated mode

Strategey 5
Go to right lane to block incoming opposing alliance robots

1.) Drive backwards

2.) Turn 90deg Counterclockwise

3.) Drive until reached lane

4.) Stop all motors

5.) Wait for teleoperated mode

6.) Go to -> Teleoperated mode

Strategey 6
Go to leftlane to block incoming opposing alliance robots

1.) Drive backwards

2.) Turn 90deg Clockwise

3.) Drive until reached lane

4.) Stop all motors

5.) Wait for teleoperated mode

6.) Go to -> Teleoperated mode