TANK_CDR

download TANK_CDR

of 30

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