TANK_CDR
-
Upload
josue-garcia -
Category
Documents
-
view
214 -
download
0
Transcript of TANK_CDR
-
7/28/2019 TANK_CDR
1/30
Autonomous Sensor and Control
Platform Rover
Tae Lee
Josh Reitsema Scott Zhong
Mike Chao
Mark Winter
-
7/28/2019 TANK_CDR
2/30
Detailed Subassembly
Scott Main control and Processing
Tae Motor Control Hardware
Mark
Sensor interfaces Mike Wireless Communications
Josh Video and High Level Control
Software
-
7/28/2019 TANK_CDR
3/30
System Overview
-
7/28/2019 TANK_CDR
4/30
Mainboard
68HC11K1
XCS10
EPROM and SRAM Bus Drivers
-
7/28/2019 TANK_CDR
5/30
-
7/28/2019 TANK_CDR
6/30
-
7/28/2019 TANK_CDR
7/30
-
7/28/2019 TANK_CDR
8/30
Motor Controls
What we have: Two Pittman GM8000 series DC GearMotors
HEDS-9000 series optical encoder
The plan:
Use two LMD18200T H-Bridges to control the motors PWM is used to control speed (Duty Cycle)
High/Low logic for direction
Brake feature
HEDS 9000 series optical encoder These will give rotational/direction information of each motor
HCTL 2020 Decoder 16-bit Decodes quadrature signal from the HEDS-9000
Outputs a count (rotational speed) and direction signal
Provides interface to MPU
-
7/28/2019 TANK_CDR
9/30
Motor Current Delivery
H-Bridge
Use two LMD18200T H-Bridges to control the motors Duty Cycle of PWM determines current sent to motors (Speed) Direction pin determines which way the motor spins
Brake Pin Thermal sensor
Note: Optical Isolation between MPU and H-bridge
FROM THE MOTORS
-
7/28/2019 TANK_CDR
10/30
HEDS-9000 Encoder/HCTL 2020 Decoder
HEDS-9000 Optical Incremental Encoder Module Used with a code wheel, detects rotary position (Shaft Encoder) Fairy accurate 500 CPR (counts per revolution) Produces two signals which need to be decoded
HCTL 2020 Decoder Decodes two signals into a count signal and direction signal The decoded signals are available on external Pins (5 & 16) Provides bus interface between encoder and MPU/FPGA Operates well in noisy environments (Motors)
Note: Optical Isolation Between Decoder and FPGA
To the MPU/FPGA
-
7/28/2019 TANK_CDR
11/30
MPU / FPGA
FPGA Create latches in FPGA, work as registers
Registers hold decoded position information
The registers are updated continually with new position
information (we can control how often it latches the new signal)
HC11K1 When needed, goes out to FPGA and grabs contents of register
HC11 will use information and compute PWM adjustments
PWM is sent out from HC11
-
7/28/2019 TANK_CDR
12/30
-
7/28/2019 TANK_CDR
13/30
Recent Discovery
LMD18200T with a LM629 Motion Control Device
-
7/28/2019 TANK_CDR
14/30
The Sensor Subsystem andInterface
Polling logic in the FPGA requests datafrom a sensor address on the sensoraddress bus.
The sensor addressed is enabled and getsdata, which it outputs to the sensor databus.
The data is taken off the sensor data businto a memory mapped latch and thepolling logic continues to the next address.
-
7/28/2019 TANK_CDR
15/30
Advantages
This interface should allow for the additionof several more sensors without anyhardware changes as long as they have a
unique address
This interface could be modified to use theI2C bus interface, thereby reducing the
sensor interface footprint.
-
7/28/2019 TANK_CDR
16/30
Schematic for Polling Logic
-
7/28/2019 TANK_CDR
17/30
IR Sensors/Driver
Upon enable, begin outputting a clocksignal of ~38kHz to IR LEDs.
Wait a few clock cycles. Then enableoutput from all 6 of the IR sensors andplace it on the data bus.
-
7/28/2019 TANK_CDR
18/30
Schematic for IR Sensor/Driver
-
7/28/2019 TANK_CDR
19/30
Ultrasonic Sensor/Driver
Once enabled send a single pulse of widthperiod ~25.3us to selected transducer unit.Begin counting time units.
Blank input from transducer for a shortperiod in order to avoid hearing the soundas it leaves.
Once input is received stop counter andoutput its value to the data bus.
-
7/28/2019 TANK_CDR
20/30
Simplifications
In order to get the sensor interface up andrunning, we will put all of the logic into theFPGA, which means that the interface will
be internal to the FPGA for now.
One of the possible extensions would beto use a second FPGA or discrete logic so
that other sensor could indeed be addedon at a later date.
-
7/28/2019 TANK_CDR
21/30
WiFi communication
Lantronix WiPort
Communicates with HC11 usingRS232
Wireless gateway for RS232transmission
Advertised indoor range of 300 ft.
Bandwidth limited by serial clock
-
7/28/2019 TANK_CDR
22/30
RS232
HC11 uses a UART with the standardnon-return-to-zero format
Same format as RS232
Selectable bit rate up to 20 kbps
-
7/28/2019 TANK_CDR
23/30
SCI (Port D) Pinouts
RXD receive data pin 2
TXD transmit data pin 3
GND ground pin 5
-
7/28/2019 TANK_CDR
24/30
Sample Transmission
Received interrupt from RDRF (received data register full
Read from input buffer SCDR
Decode the character received
Change the duty cycle of the PWM output.
Write toPWDTY1/2
DecodeTransmission
Read FromSCDR
Interrupt FromData Register
-
7/28/2019 TANK_CDR
25/30
Web Based Control
The wi-fi creates an IP-address for a web pagewhich is where the user interface will be located.
The web-page will utilize Java applets as a GUI
for the user to send information to the robotsuch as turn, or speed up, run presetautonomous programs, etc. and also to receiveinformation such as video and positioningmeasurements in a user friendly manner.
The web-control basically will call basic subfunctions that are preset into the ROM or RAMwhich will then send instructions to the motorcontroller.
-
7/28/2019 TANK_CDR
26/30
Video System
The video camera will be mounted into thefront of the robot
The data will not be sent through the wi-fidue to bandwidth concerns
A button on the webpage will access thedirect feed through an applet
No significant processing of the video willbe done
-
7/28/2019 TANK_CDR
27/30
Example Webpage
Autonomous Control and Sensor Platform Rover
F
R
B
L
KILL SWITCH
Open Video Applet
Velocity
Incoming Data:
X: 1.8 M
Y: 25 M
Speed : 3 m/sec
...
Wall Follow
Search Area
Avoid Objects
-
7/28/2019 TANK_CDR
28/30
Parts List
Rover (Pebbles III) $0
H-Bridge and Control Circuit $100
Lantronix WiPort $300
Mainboard and FPGA Charge it to Tom
IR and Sonar Included
Baby Monitor w/Video Capture $400
Quality hours spent in Capstone Priceless
Total $800
-
7/28/2019 TANK_CDR
29/30
Schedule
-
7/28/2019 TANK_CDR
30/30
Thanks