team 3 reportee192/sp12/files/... · software •initial calibration over [-10,+10] cm, linear...

12
Team 3 Report Frederick Chang, Donovan Lee, Joshua Schrier

Upload: others

Post on 04-Aug-2020

1 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Team 3 Report

Frederick Chang, Donovan Lee,Joshua Schrier

Page 2: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Hardware—Sensors• Standard induction

setup, 2 sensors,expanded to 4

• Velocity detection usingall-in-one Hamamatsu– Reduced part count

• 6x 2-stage non-invertingamplifier– Tunable low-pass

filtering, gain; ability toexpand sensor model

Page 3: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Hardware—Actuators

• Upgraded servo– KO Propo 2343 Digital

– Slew rate 0.08ms/60deg

– High Speed Responsemode

• H-bridge motor driver– Faster braking

• Velocity encoderpainted directly onmotor gear– Reduced part count

Page 4: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Hardware—User Interface

• LCD panel/keypad– Long initial time

investment

– Fast debugging,parameter setting

– On-track calibration

• Piezo Speaker– Useful for initial

debugging, easy toimplement (PWM)

– Not as much informationdensity as LEDs

Page 5: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Hardware—Construction• Styrofoam structure

– Rapid prototyping– Cut with hot wire

• Fiberglass coating– Make styrofoam

permanent

• Carbon fiber rods– Lightweight, cheap

• Rubber bands/zip-ties– Quickly change structure– No large investment in a

bad structure

Page 6: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Hardware—Iterations

Page 7: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Sensors

es

tim

ate

d y

a/c

m

actual ya/cm

• Startup calibration over [-10,+10] cm range• Linear interpolation between calibration values in mm• Source of error: parallax when calibrating

Page 8: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Software

• Initial calibration over [-10,+10] cm, linearinterpolation between data points

• User Interface– State-machine based– Turns off Interrupts while in UI handling– All gains, parameters tunable using UI– Sensor readings, ya interpretations available

• Servo control PI parameters stored as float,conversion to integer values; all other valuesoperated as 16-bit integers

• PD control—no track memorization

Page 9: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Control

• Velocity Control (P)– Kp =63.6 duty% / (m/s)

• Servo Control (PD)– Kp = 69.8 rad/m– Kd = 0.00291 rad/(m/s)

• Steering state machine– On loss of track, use last known state to steer– Reduce speed if off track

• Straightaway detection– Use front sensors (“hardware lookahead”)– If {|ya|, |ya_dot|, |ya_front|} < error, increase speed– Separate servo Kp, Kd parameters at high speed

Page 10: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Performance

Step Response (at constant 1m/s)

-15

-10

-5

0

5

10

15

1.4 1.5 1.6 1.7

Distance[m]

Off

set[

cm]

Page 11: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Modifications for NATCAR

• Smoother controller– Change velocity smoothly depending on tracking quality– Digital filtering of control to reduce oscillations

• 4WD, full suspension chassis (TC3)• Decrease resolution dropoff after ±8 cm• Broader frequency response of sensors• Track memorization

– Step 1: Feedforward velocity– Step 2: Feedforward orientation– Memory: 2ms sample interval over 40 seconds,

~40 kbytes storage

• “Lasers” to destroy DeVry, Davis cars

Page 12: Team 3 Reportee192/sp12/files/... · Software •Initial calibration over [-10,+10] cm, linear interpolation between data points •User Interface –State-machine based –Turns

Credits

• H-Bridge, Power Sch - JS

• H-bridge/Pwr PCB - FC

• Construction - DL

• Sensor Hardware - DL

• Sensor Software - JS

• UI - FC

• Control - ALL

• Debugging & Tuning - ALL