Esplanade Runner - Autonomous Vehicle Navigation in Small Vehicles

Contents

1  Introduction  5

1  System Layout  6

2  System Communication  7

3  System Specifications  9

3-A  Proposal Specifications  9

3-B  Specifications as Tested  10

4  Project Budget  10

2  Hardware and Sensors  11

1  Schematic and Wiring  12

2  Mounting  12

3  Compass Sensor  14

4  Acoustic Sensors  15

5  GPS Unit  16

6  Site Selection for Testing  17

7  Power Systems  17

3  MCU  19

1  Functionality  21

2  Programming and Debugging  22

2-A  Programming  22

2-B  Debugging  23

3  Issues  23

4  PDA  25

1  Introduction  25

2  Functionality  25

3  Programming and Debugging  27

4  Issues  28

5  RouteDraw Web Tool  31

1  Functionality  32

2  Programming and Debugging  33

3  Issues  33

1

CONTENTS

  2  

6  Simulation Tools  35

1  Functionality  36

1-A  Full System Simulation  36

1-B  PDA Testing Simulation  37

2  Programming and Debugging  38

3  Issues  38

7  Basic System Operation  41

1  Site Selection  42

2  Route Drawing  42

3  Loading PDA  43

4  Running the Esplanade Runner  43

5  Issues  44

  A Component Specification Sheets  47

1  Garmin eTrex PDA Specifications  48

2  CMPS03 Magnetic Compass Chipset  49

3  MMP 8 Mobile Robot Platform  50

4  SRF05 Ultra Sonic Ranger  51

5  M68 DEMO908 GB60 MCU Board  52

6  Hewlett Packard iPAQ RX1955 PDA  53

7  GPS TEXT Output Communication Format  54

8  MCU Internal Schematic  57

  B Specification Discussion  59

  C Future Steps  61

1  RouteDraw Web Tool  61

  Glossary  63

  List of Figures  

1.1  Vehicle in attack-mode  5

1.2  Diagram Showing the Flow of Control in the System  8

1.3  Diagram Describing System Communication  9

2.1  3 D Model Used for Acoustic Sensor Placement  11

2.2  System Schematic  12

2.3  A picture of the vehicle with all the components mounted  13

2.4  Compass Chipset  14

2.5  Acoustic Sensor Chipset  15

2.6  Acoustic Sensor Timing Diagram  16

3.1  MCU Development Board  19

3.2  MCU USB Programmer Setup  23

3.3  MCU Connection Manager Settings Panel  23

3.4  Hyperterminal Serial Port Settings  24

4.1  Logging Screen showing the entries recorded for a very small course  26

4.2  Visual Studio 2005 Create Project Window  28

4.3  The Debug Menu allowing the user greater control of the PDA functionality and  

  the system settings  29

5.1  Drawing a route around the baseball diamond using the WebTool  31

6.1  Simulation of the MCU and Vehicle Dynamics  35

6.2  The results of a simulation where the compass is poorly calibrated and has a large  

  steady-state error the top graph is the vehicle path the bottom graph is a plot  

  of the compass readings vs. time where the red is the actual orientation and the  

  blue is the compass output  39

7.1  A field test being conducted in Amory Park  41

7.2  Parameter Screen on EspRunner application running in PDA emulation environ  

  ment  44

  A 1 The Acoustic Sensor’s Beam Profile  51

3

Chapter 1

Introduction

CHAPTER 1. INTRODUCTION 6

Executive Summary

The task of autonomous vehicle navigation coupled with obstacle avoidance is a notoriously difficult problem involving communication with a variety of sensors and a motor control system in real time. Our project is to create a system that will enable a mobile platform to navigate a given route, while avoiding obstacles in its path. This system consists of a portable digital assistant (PDA), a microcontroller unit (MCU), and three different sensory devices, namely, a Global Positioning System (GPS), a digital compass, and acoustic sensors. The combination of the PDA and MCU algorithmically interacting with these sensor devices creates a system that maneuvers a vehicle through a user-determined route.

1 System Layout

The concept behind this system is to utilize the information from all of the sensors to determine the answers to a few simple questions; where are we, where do we need to go and how do we get there?

We utilize a handheld GPS unit to pinpoint the vehicle’s current location (longitude, latitude), along with where we need to go. By using a digital compass to correctly orient ourselves in the desired direction, we repeat this procedure iteratively until we’ve successfully completed our route.

There are four main elements to this process: the web application, the PDA, the MCU and the sensory devices each playing a role to the overall function of the vehicle.

The web application has three main functions. The first function is a web tool based on Google Maps that allows any user to use the satellite imagery of the earth and define a waypoint based route using only a few simple mouse clicks. The second of these functions is to translate the user defined route into a series of longitude and latitude coordinates that the PDA program will later use as the basis for its positional information. The last function is creating a file that can then can be transferred and read by the PDA as a map.

The PDA application has two main functions. The first of which is determining current location, desired location and all relative information required to connect the two. The PDA does this by requesting GPS data via the MCU. Once the PDA receives the requested data, the PDA uses the vehicle’s current position and the next waypoint in the route file that was generated by the web tool and calculates the direction between its current position and the next waypoint. The PDA sends this angle as a command to the MCU which translates that command into signals to the motors. In addition to this navigation command, the PDA also serves as the user interface for the entire system. From this UI, the user can start/stop the vehicle and set parameters pertinent to system operation (forward and rotate speed, sensor threshold, toggling obstacle avoidance, etc).

The MCU plays an important role in directly interacting with the sensors and providing real-time when they are needed such as during obstacle avoidance and turning. It is in charge

2. SYSTEM COMMUNICATION 7

of communicating, relaying and interpreting all data that passes through it. The MCU links the PDA, GPS unit, digital compass, acoustic sensors and motor control of the vehicle into a single coherent unit. Each of our components employ a distinct communication protocol and attempting to link them without a central unit to understand and standardize them would prove extremely difficult if not impossible. From the perspective of the entire system the PDA serves as the master and the MCU as the intermediary and the remaining components as the slave. When requested by the PDA, the MCU requests data from the GPS and compass and forwards it back to the PDA.

While the system is operating, the MCU functions also as an obstacle watchdog constantly pinging the acoustic sensors to determine if an obstacle exists anywhere near the body of the vehicle. If the sensors indicate there is an obstruction in its path, the MCU uses its real-time obstacle avoidance algorithm to steer clear of the object and continue along with its path once it has cleared the obstacle. The last function of the MCU is to generate signals to the motors known as pulse width modulation (PWM) that control the speeds at which the motors rotate.

The sensor units each have one primary function, and that is to acquire data indicating whether there is an obstacle in front of it. The sensors are positioned so that it is able to detect potential obstacles on the left side, right side, and in front.

The handheld GPS communicates with satellites in the sky and sends data regarding its exact location on the earth in terms of longitude and latitude coordinates. The GPS is connected to the MCU via serial- port and is constantly transmitting the coordinates of its current location. The digital compass’ provides the deviation from magnetic north. The compass is used to position the vehicle at the correct angle, in order to head in the right direction. It communicates with the MCU by means of the I ² C protocol. The acoustic sensors are then used to detect if an

obstacle is blocking the path of the vehicle.

2 System Communication

Communication between the different components is essential to the core of our system. Because the MCU acts as the central control unit, all components communicate via different protocols to ensure that all data do not end up on the same bus and thus risking data interference.

The GPS communicates with the MCU through a serial port connection. This data transfer is a one way (MCU does not request data from the GPS, MCU selectively ignores data bursts until the PDA requests it) in which the GPS constantly sends all information regarding current coordinates to the MCU in a string format output.

The acoustic sensors are connected to the MCU by a general purpose IO port. When information from a particular sensor is requested, a pulse is generated by the MCU, sent down the line which is translated by the sensor’s internal circuitry into an ultrasonic acoustic pulse emitted by the sensor chip. When the acoustic pulse returns (echo), the sensor chip translates the response into another pulse which is sent back to the MCU on the same IO port. By using the linearly proportional relationship of time between pulse and echo and speed of sound, the MCU can determine the distance at which an object is detected.

CHAPTER 1. INTRODUCTION 8

the compass sends its current heading to the MCU in byte form, where the MCU can then use this information to rotate the vehicle to the desired heading.

The PDA is connected to the MCU through the MCU’s second serial port. This connection is a bi-directional communication in which the PDA and MCU can send information back and forth. The MCU takes the GPS data string that it receives and forwards this information to the PDA. Once the PDA calculates the angle that the vehicle should rotate, it then sends this angle back to the MCU through the serial port connection with instructions to rotate the vehicle until the desired heading is reached.

The MCU’s PWM module is responsible for regulating the signals sent to the motors are responsible for vehicle motion. Based on the MCU’s instructions of how fast and which direction the vehicles motors should rotate, the MCU will send a duty cycle pulse of 1.0 - 2.0 milliseconds, 1.0ms being the maximum reverse speed, 2.0ms being the maximum forward speed, and 1.5ms being the dead zone.

3. SYSTEM SPECIFICATIONS 9

3 System Specifications

In out initial proposal we produced a number of specifications for the operation of our vehicle

and system based on simulations, research, and manufacturer specifications.

3-A Proposal Specifications

Vehicle and onboard computers Specifications

• Operational Specs

- Minimum operating speed is 1 foot/second

- Climbs 10% grades

- Operates anywhere with GPS coverage

- Operates for at least 1 hour without recharging

- Operates on 12V battery pack

- Operates on concrete or short grass surfaces

- Adapts route to avoid objects greater than 20cm × 20cm × 20cm

- Withstands impact of up to 1 foot/second without loss of performance

CHAPTER 1. INTRODUCTION 10

- Will navigate the predefined route within a 20 foot radius

• Modular Design (components can be removed and added)

3-B Specifications as Tested

• Vehicle is within 5-10 feet of desired route, in the absence of obstacles, given a GPS fix of 3 or more satellites

• Vehicle travels at 2.5 feet/second and the speed can be adjusted from 0.7 feet/second to 3.7 feet/second

• Vehicle can climb 20% grade

• Vehicle operates for approximately 40 minutes depending on conditions

• Vehicle is easily capable of navigating concrete, grass, dirt paths, and bumpy fields. Per-formance however as the terrain quality decreases.

• Withstands impact of up to 3 feet/second into solid object (testing on tree) without loss of performance

• Vehicle avoids obstacles with at least a 15cm × 15cm cross section to the vehicle sensors

• Vehicle communicates with GPS using TEXT standard developed by Garmin and available in all of their products

The discrepancies and changes made between these two specifications are discussed in detail in Appendix B (Page 59).

4 Project Budget

Chapter 2

Hardware and Sensors

The hardware and sensors are a crucial area of the project since this is how all everything is physically connected together and the communication methods between components. Much of our time was spent this semester in determining and documenting how many of these standards worked because the available material was not adequate.

11

CHAPTER 2. HARDWARE AND SENSORS 12

1 Schematic and Wiring

2 Mounting

The way in which we mounted all the hardware on vehicle was important in the design process because nothing could be drilled or permanently attached to the car. Everything connected to the actual vehicle must be temporary. Because the vehicle is built on two separate planks that move up and down individually, we could not mount all the components on one plane and rest it on the entire surface. To overcome this challenge, we created a system that is raised above one side of the vehicle so that it will not interfere with the up and down motion of the two planks. A cork plate is used to support the PDA, the GPS, the MCU, and the compass. To attach all the components we use double sided velco tape. Velcro is the ideal mounting material because it is strong and will support the weight of the components, yet it is temporary and does not destroy