Autonomous Navigation Workshop

Download Report

Transcript Autonomous Navigation Workshop

2009 Control System
Workshop
January 10, 2009
Farmingdale State College
SPBLI - FIRST
Mark McLeod
Advisor
Hauppauge Team 358
Northrop Grumman Corp.
[email protected]
Agenda







FIRST Control System Overview
Team Assembly
Benchtest
Firmware Updates
Wireless Setup
Re-Benchtest
Download Programs & Test
FIRST Control System
Hardware


Driver
Gather around demo robot
–
–
–
–
Driver Station (DS)
Router (for non-competition use only)
Disable/Enable Competition Port switch
Joysticks (HID compatible only)
–
–
–
–
–
–
–
cRIO
Bumpers (Analog, Pneumatic)
Digital Sidecar
Power Distribution Panel (PD)
Wireless Bridge
Jaguar (or Victor) Speed Controllers
Spike (primarily for compressor or other motors)
Robot
cRIO


400mHz,
64MB/128MB
Fixed positions for:
– (2) Analog modules
– (2) Digital Modules
– (1) Pneumatic Module



(2) Ethernet ports
(1) serial port
(console)
24v power
Driver Station (DS)











50Hz update rate
(4) USB ports-joysticks
(2) Ethernet ports
(1) Competition Port
(8) Digital Inputs
(4) Analog Inputs
(8) Digital Outputs
Auto/Teleop toggle
No hot-swapping joysticks
Joysticks must be centered
at bootup
Will run off 9v batteries
Dongle
 MUST be attached
for DS to run
 Connects pin 8 to 9
Power Distribution Panel
(PD)



(8) 40A connectors
(12) 20/30A connectors
(2) Power-Safe Connections
– 24V output for cRIO
– 12V for WiFi



5V for camera
Power input uses metric M6
nuts-don’t over torque
LEDs for 3 special
connectors
Digital Sidecar



12V via Wago connector
DB-37 cable to cRIO
(10) PWM outputs
– Jumper for servo use






(14) Digital IO (GPIO)
(8) Relays
I2C Interface (connector &
pins)
2-pin status light output
Power status LEDs 5v, 6v,
12v
Need to add cable nuts
Analog Bumper/Breakout


(7) Inputs
(1) Special Input
Jumper controlled
– Battery voltage
– Standard Input



12V Wago power
Green power LED
CANNOT survive
reversed polarity
Pneumatic
Bumper/Breakout




(8) Outputs
12V Wago power
Green power LED
ONLY board with
reverse power
polarity protection
– Test white Wago
connectors for other
devices/boards here
Axis Ethernet Camera






Ethernet Web-ready camera
Connects to cRIO port 2
Requires special crossover
cable (orange)
Black lens turns to focus
Reset button on back
Use “Setup Axis Camera” on
PC to configure it for FRC
competition use
Wireless Bridge/Wireless
Router

Bridge
–
–
–
–

On robot
12V power from PD
Ethernet to cRIO port 1
Disconnect to tether in pits
Router
–
–
–
–
For DS and PC
NOT for competition
AC power
Ethernet to DS ETH1 port
Jaguar Speed Controller








20kHz PWM frequency & 5ms
update rate (Victors are 17ms)
Limit switch inputs
(forward/reverse)
Coast/Brake (jumper or DIO)
PWM cable retention clips
Slow flashing Yellow LED
indicates no valid pwm signal
Slow flashing Red LED
indicates limit switch, over
temp/current, or under voltage
<6V
Over-current protection can
cause motors to cut out in
pushing matches
Fan runs only when needed
What We’ll Do Today
Follow step-by-step directions in the 2009 Control
System manual at: usfirst.org/frccontrolsystem
 Connect everything
 Bench test
 Update the firmware (DS & cRIO)
 Bench test
 Setup wireless networking
 Bench test
 Download LabVIEW & Wind River programs
Wiring-Power
Wiring-Data
Assembly Steps

Wiring
– Battery w/ Anderson Connector (6 awg)
– 120amp breaker w/ Anderson Connector w/ Power Distribution
(PD) Board (6 awg)
– cRIO to PD (18 awg)
– Digital Sidecar
 DB37 cable to cRIO (attach cable nuts to Sidecar first)
 White Wago connector to PD (18 awg)
 Attach test servo to Digital Sidecar & add power jumper
– Analog & Solenoid Bumpers
 Directly attach to cRIO
 White Wago connector to PD (18 awg)
– Wireless Bridge (requires cutting the cord off the adaptor)
– Camera power (requires cutting the cord off the extra adaptor)
– Wire Jaguars/Victors to PD
Assembly Steps

Triple check wiring polarity
– Unplug Analog Bumpers to test in Solenoid Bumper first
– Add circuit breakers
– Add jumpers to Analog Bumpers (battery feedback vs normal)

Power it up
– One at a time plug the wago connectors into the Solenoid
Bumper (a green light means is wired correctly)



(2) for the Analog bumpers
(2) for the Digital Sidecars
(1) for the Solenoid
– Connect the verified power lines to the Sidecars & bumpers


All lights should be green (or Jaguars blinking yellow)
Connect Servos to Digital Sidecar – add jumpers
Driver Station (DS)
Connections




Connect joysticks to USB1 & 2
Connect ETH1 port to cRIO port 1
Attach Disable/Enable switch
Plug in power
Bench Test I



Verify green power status LEDs on PD,
Bumpers and Digital Sidecar
Basic objective is to move a joystick at
the DS end and have a motor respond
at the cRIO end
Default is Arcade (1 joystick) while a
top button is pushed
DS Firmware Update


Both DS & cRIO must be updated together
Driver Station (DS) (Manual 5.1.1)
– USB memory stick (some do not work)
– Firmware update & detailed directions at
http://www.usfirst.org/frccontrolsystem
– Rename update file to: “dsud_pkg.bin” (make sure file
extensions are not hidden on your PC)
– Copy to top level of USB memory stick
– Plug USB stick into DS
– Hold both up & down arrow buttons for ~8sec
– Follow further directions on DS LCD screen quickly – if the DS
screen goes back to normal then you’ve either been too slow or
your memory stick/update file was rejected.
– Do NOT interrupt the loading process once it puts up the big
warning

Set team number (Manual 5.3.2)
cRIO Firmware Update






Confirm PC LabVIEW update
Manual 5.1.2
Watch for laptop issues
Power up the cRIO and connect your PC through the DS
ETH2 port
Firmware update at
http://www.usfirst.org/frccontrolsystem as part of the
LabVIEW FRC software update
Start the “FRC cRIO Imaging Tool”
–
–
–
–
–
Choose Development Environment
Click “Format Controller”
Select Image: FRC_2009_v7.zip
Device Name: FRC-cRIO-team#
Team ID: team#
Bench Test II


With new firmware behavior will differ
USB1 joystick throttle selects arcade or
tank drive
Wireless Setup


Bridge (Manual 5.6.1)
–
–
–
–
–
–
Connect PC to Bridge via Ethernet
Set laptop IP to DHCP
Browse to 192.168.1.250 (admin/admin)
Basic -> Wireless
Basic -> Network Settings
Connect to cRIO port 1 (disconnect DS Ethernet cable)
–
–
–
–
–
–
–
–
Set laptop IP to DHCP
Connect PC to Router via Ethernet
Browse to 192.168.1.1 (blank/admin)
Wireless -> Manual
Setup -> Basic Setup
Set laptop IP to 10.XX.YY.6, Mask: 255.0.0.0, Gateway: 10.XX.YY.4
Connect to DS ETH1 port
Connect PC to DS ETH2 port
Router (Manual 5.6.2)
Bench Test III


Same behavior as Bench test II
Start LabVIEW Dashboard project
Cautions









The cRIO and camera cases must be electrically isolated. Don’t
mount on metal.
The DS must NOT lose power or be interrupted while the firmware
is being updated
Don’t reverse polarity anywhere! Triple Check!
Don’t mixup the voltage (24v,12v,5v) requirements
Test all 12v white Wago power cables on the pneumatic bumper
first. It alone has reverse power protection and a green light
means your cable is good.
Don’t over-torque the Power Distribution M6 nuts (10mm wrench)
Don’t confuse the (2) Analog bumpers with the (1) Solenoid
Bumper
The robot WiFi MUST be powered by the special connector on the
PD. That connector is protected against sudden power drops while
the regular 12v connections will be shutdown momentarily to
conserve power.
The cRIO modules and bumper power connectors can be shaken
loose
Notes







The DS inputs have a value if nothing is attached
The orange Ethernet cable is a special crossover cable
for use with the camera.
Servos require a jumper on the Digital Sidecar
The system takes a long time to startup.
The cRIO and WiFi will operate at 4.5V and survive
transients down to ~3.5V
The Digital Sidecar will shutdown the PWMs when
battery voltage hits ~5V, so they’d start dropping out as
the voltage dips below 5V
Joysticks must be centered when the DS is powered up.
Similar to N64 or Gamecube.
Oddities




The DS LCD can blank out from a static
discharge, but the DS keeps working fine.
Some Power Distribution 5v LEDs don’t
work, but the power is fine.
The PD will squeal at times from the 12 &
24V boost supplies cycling
Some redundant loose parts found in PD
and Digital Sidecar should be removed.
Links to Further
Information


Firmware Updates & Control System
Manuals:
http://www.usfirst.org/frccontrolsystem
Jaguar Getting Started:
http://www.luminarymicro.com/index.ph
p?option=com_remository&func=downlo
ad&id=1127&chk=ed03ce56ed47704071
431b33a1fe7e20&Itemid=591


Presentation slides at:
Team358.org
Questions/Help please email
[email protected]