S14: Autonomous Control System

From Embedded Systems Learning Academy
Revision as of 06:38, 23 May 2014 by Proj user20 (talk | contribs) (Software Design)

Jump to: navigation, search

Spartan Superway Control System

Pod

Abstract

SJSU’s Spartan Superway will provide an automated, solar-powered PRT system. The objective of this particular project, within the Superway initiative, was to develop an autonomous control system for all pods (vehicles) using a wireless mesh architecture. The control system is to communicate with a central computer that would send new destinations to pods as they arrive at a station. The pods are to navigate the track system autonomously and communicate updates on their location to the master computer. This project is part of the larger SJSU Spartan Superway, more information on the project can be found at: Spartan Superway Homepage

Objectives & Introduction

The main purpose of this project is to design an Autonomous Control System for the Spartan Superway project initiative. The control system must be able to do the following:

  • Wireless Communication
    • Pods must communicate their location to a master computer and tell the master computer when ready for new route.
    • A master computer must send new destinations to pods when their route is complete.
    • Master computer knows the location of each pod on the system, throughout the travel time.
  • Pods must display intelligence, and navigate a track autonomously.
    • A line follower must be designed to demonstrate a working control system.
    • A State Machine will operate the pods as the central component on each pod.
    • Pods (vehicles) on the system must autonomously navigate a given track using a combination of IR sensors and directions generated by a shortest path algorithm (Dijkstra).
    • All operations must be executed in real time, therefore use of the FreeRTOS is necessary.

Team Members & Responsibilities

  • Elizabeth Poche
    • Driver & Line Follower Development
  • Eriberto Velazquez
    • FreeRTOS Software Design
  • Trent Smith
    • SNAP Communication

Schedule

Week# Date Planned Actual
1 3/28
  • Schedule of project
  • Elizabeth - pod following line
  • Eddie - Design a state machine in FreeRTOS tasks
  • Trent - Research on devices Wireless
  • Pod follows line using RC circuitry.
  • State Machine completed.
  • Decided on using SNAP OS with RF266PC1 for wireless
2 4/4
  • Elizabeth - pod able to fork and stop at a station
  • Eddie - Form tasks for the State Machine and Line follower
  • Trent - Tested RF266PC1 devices with SJONE UART3
  • Wireless testing complete.
  • Tasks created, ready to integrate pathing algorithm.
  • Pod can go straight, turn right, or stop at node
3 4/11
  • Elizabeth - pod counting location tick marks
  • Eddie - Inter-task communications and shared objects/queues
  • Trent - Wireless task for SJONE
  • Inter-task communications completed.
  • State machine receives list of directions to navigate track.
4 4/18
  • Elizabeth - pod can take commands from hard coding going from one station to another
  • Eddie - Include wireless control functionality to state machine task
  • Trent - Wireless task integration and black box testing
  • pod goes from one station to another using hard coded instructions
5 4/25
  • Elizabeth - pod can take commands from wireless of going from one station to another
  • Eddie - FreeRTOS Implementation and Testing
  • Trent - Created a master for to monitor wireless network traffic.
  • Built new track for pod
  • Pod goes from one station to another by pushing button to go to certain station
  • Monitors pods status from PC.
6 5/2
  • Elizabeth - test pod with dijkstra and with whole system
  • Eddie - Continue FreeRTOS Implementation and Testing
  • Trent - Optimized groups code, removed unused and redundant code.
  • Pod goes from one station to another by communicating to it via SNAP wireless
7 5/9
  • Elizabeth - Help develop a project demo
  • Eddie - Help design demo track
  • Trent - Help with testing and demo
  • Finishing demo preparation
8 5/16
  • Elizabeth - Work on pod logic diagrams and sections of the report
  • Eddie - Write FreeRTOS related sections of the report
  • Trent - Write Wireless communication related sections of the report.
  • Finished demo preparation

Parts List & Cost

Name Part Quantity Cost Each Total Cost
Pod Chassis Arduino Compatible Magician Chassis 3 $15 $45
H-Bridge L298 3 $3.64 $10.92
IR LED/Sensor TCRT5000 15 $0.58 $8.69
DC Battery Tenergy 9.6V 2000mAh NiMH Battery 3 $23.55 $70.65
SJOne Board LPC1758 Development Board 3 $60 $180
Buck Converter LM2596 3 $3.00 $9.00
Voltage Regulator NTE 960 3 $2.00 $6.00
4-1 Mux 74HC153 3 $1.00 $3.00
Hex Inverters 74LS04N 3 $0 $0
SNAP Wireless 3 $0 $0

Design & Implementation

Hardware Design

Pod Top View


The main hardware components used in this project include:

  • SJOne LPC1758 Development Board
  • Motor Driver
  • IR LEDs
  • Mux
  • Inverters
  • Battery
  • Buck Converter
  • 5V Voltage Regulator
  • SNAP Wireless
  • Chassis and Motors


Pod Chassis and Motors

This is the frame of the pod where parts can be attached to. The chassis includes two DC motors.

SJOne LPC1758 Development Board

This is the 'brains' of this project. The development board package uses FreeRTOS C/C++ and provides UART and SPI ports which are used in this project.

Figure 1: SJOne Development Board


Mux Logic

When the pod reached a node it will take a new instruction from the state machine to either continue straight, turn right, or stop. Figure 2 and Table 1 show the mux logic and the four different modes it can be in depending on a and b inputs. If the pod was instructed to continue straight through node, the software chose straight mode and turned on both wheels until either Left AND Right, OR LLeft AND Left AND RRight, OR LLeft AND Right AND RRight signals saw white. If the pod was instructed to turn right, the software chose right mode and turned off the right wheel and turned on the left wheel until LLeft AND Left OR LLeft AND Right signals saw white. If the pod was instructed to stop, the software went into RC mode and since the station was black, the sensors did not see a reflection and therefor stopped both wheels. The pod remained stopped and waited for the next instruction.

IR LEDs

Figure 3: IR LEDs


The IR LEDs contain and emitter and a sensor. The emitter will always provide an IR signal. The sensor will only sense the IR if the IR is reflected back.

Figure 3: IR Reflective

When IR signal hits reflective ground, the signal will reflect back to the sensor and the sensor will output a false logic.


Figure 4: IR Non-Reflective

When IR signal hits non-reflective ground, the signal will not reflect back to the sensor and the sensor will output a true logic.


Motor Driver

Figure 6: Motor Driver

The motor driver controls the left and right motors. The Left EN Motor and Right EN Motor pins will enable or disable the motors. Both wheels are tied to go only forward.


Voltage Regulators

The voltage regulators are used to step down the voltage from the battery pack. The buck converter is used control the voltage level to the motors, shown in Figure 7. To increase the speed of the motors, adjust the POT.

Figure 7: Buck Converter


The 5V voltage regulator is used for the SJOne board, inverter, mux, and pin enables.

Figure 8: 5V Voltage Regulator

Battery

This provides power to all components on pod.

Figure 7: DC Battery


Station Design

The station design allows the pod to fork to another track and off the main track. The pod will sense a node using LLeft and RRight sensors and receive a new instruction from the queue.

When a right instruction is given, the pod will stop its right wheel and turn on the left wheel. When straight instruction is given, the pod will turn on both right and left wheels. When stop instruction is given, the pod will stop both left and right wheels.


Figure 9: Station Design

Track Design

The track was designed to have three stations and a fork and merge, not counting station's fork and merge. Between each node there is a given weight of the path. This represents the length of the track. The algorithm will calculate the shortest path using these weights.

Figure 10: Track Design

Pod State Machine

The pod is in a state machine, Figure 11 shows the logic of the pod for one iteration. The pod will start at a source wait until it is given a destination. The pod will leave the station and make its way along the line. When it reaches a node, it will receive a numerical instruction. The pod will continue to travel to its destination until it receives a stop instruction. When this case happens, the pod is at its destination and will wait for a new destination.

Figure 11: Pod State Machine


SNAP Wireless

The SNAP wireless connects the pod to the master controller. The state machine is the central server that has access to all pods and has the authority to override any current commands and other controllers. Figure 12 shows the communication between the master controller and pods.

Figure 12: Wireless Communication

Hardware Interface

To implement the pod system, small steps had to be taken to avoid periods if the hardware design did not work and could not isolate the issue. In the event the design did not work there was a previous design that worked. The design process started with a baseline using a simple prototype. A simple line follower was built to learn the basics of the line follower. To make the pod intelligent, a microprocessor was integrated. To get the line follower working, hardware and software were combined. Hardware controlled the pod, which followed the line and software gave user the control over the pod’s path traversal. The line follower followed a line using IR emitters and receivers, which pointed down, toward the ground. The emitter sent a constant IR signal. If the signal hit white part of the track layout, the signal reflected, and if the signal hit black tape, the signal did not reflect. Using this technology, Left and Right IR signals were used to follow the line.

//ADDED Figure 1 shows the SJOne Board pinout and the connections between the SJOne board, multiplexer gate, and inverter gate. The SJOne board uses outputs a and b to select which direction the pod should perform when reaching a node; straight, right turn, or stop. Figure 2 and 3 show the logic of the mux. Left and Right IR LED output was inverted because with out the inverter the IR LED did not give HIGH and LOW logic within the voltage levels of the mux. LLeft, Middle, and RRight were not inverted because outputs gave correct voltage levels for HIGH and LOW to the SJOne board.

Figure 1: SJOne Board Pinout


Figure 6: H-Bridge Pinout

Figure 5 shows the pinout of the IR LEDs

Figure 5: IR LED Pinout

The pins used in IR LEDs and mux are GPIO. If pin is an output, it can output a HIGH or LOW depending on the software. If pin is an input, it will sense a HIGH or LOW and use that input in the software.

Figure 7: Buck Converter Pinout

Software Design

The Superway Control system takes advantage of the FreeRTOS’ multi-tasking capabilities. The control system is divided into multiple tasks, each having their own separate responsibilities.

State Machine Task

This is the central component within the system, it communicates with all other tasks in the system via shared queues. It is responsible for transitioning the vehicle from a ready state, in which it is ready to receive new directions, to a traveling state. The states are as follows:

  • Startup – This is the initial state where all initializations occur.
  • Ready – SM remains in this state whilst no new destination has been received by the pod (vehicle. It signifies that the pod is ready to begin a new route and is awaiting a new destination. If a new destination arrives, the state machine sends the starting location and destination to the path generating algorithm and then transitions to the next state, receiveDir.
  • ReceiveDir – Here, the state machine receives a list of directions, from the Dijkstra algorithm, that will help the pod navigate the track system and reach its new destination, once all directions are received it transitions to the next state, load.
  • Load – Currently, this state does nothing but transition into the “travel” state. It remains in the code for future progress on the control system, where a loading of passengers sequence must be simulated for a real transit system.
  • Travel – This is the main state the state machine will remain in during navigation. During this state, the state machine communicates with the line follower task and sends the instructions necessary for navigation. This state also updates the master computer with location information. Once the pod reaches its destination, the system transitions into the arrive state.
  • Arrive – In this state, if the line follower sends a signal, it tells the state machine that the pod has successfully reached its destination and a delay is put in place to simulate the offloading of passengers. Now the system returns to the ready state.
  • Error – While not used in this implementation the error state remains in the control system’s state machine for future use. This would become the default state when initializations fail or any other state fails.
General State Machine

Pathing Task

This task contains the path generating algorithm, Dijkstra’s shortest-path algorithm. It communicates directly with the State machine task at the beginning of a new route. This task is responsible for determining the set of instructions the pod must follow in order to reach its destination from its current location. When a path is determined, a set of instructions corresponding to which turns must be made and at what points is generated and then passed back to the state machine.

Line Follower Task

This task has the sole responsibility of controlling the motors and reading from the Infra-red sensors that keep the pod on the track. The task also communicates with the State Machine in order to receive the list of instructions that it must execute as it traverses the track. As a node is approached all five IR sensors are triggered, at this time the line follower task must read the next instruction in the list. These instructions will tell the line follower to go straight, make a turn, or stop at the given node. Once the destination is reached, denoted by a special character at the end of the list, the line follower task sends a signal to the state machine task.

Code Function Description:

  • getRRight() – return RRightsensor value
The purpose of this function was to read RRight sensor and return a boolean value. This function does not have any arguments.
  • getRight() – return Rightsensor value
The purpose of this function was to read Right sensor and return a boolean value. This function does not have any arguments.
  • getMiddle() – return Middlesensor value
The purpose of this function was to read Middle sensor and return a boolean value. This function does not have any arguments.
  • getLeft() – return Leftsensor value
The purpose of this function was to read Left sensor and return a boolean value. This function does not have any arguments.
  • getLLeft() - return LLeftsensor value
The purpose of this function was to read LLeft sensor and return a boolean value. This function does not have any arguments.
  • setup() – initialize pod
This function initializes the pod to the correct state. All used GPIO pins were set to either input or output. Clock is set to CLK/1. Interrupt was enabled. This function does not have any arguments or return any values.
  • loop() – forever loop
The pod stays in this function after setup(). It was an infinite loop to allow the pod to receive new instructions. This function does not have any arguments or return any values.
  • RCmode() – follow line
Using RC circuitry, the pod will follow line until it reached a node. Nodes were defined when LLeft and RRight sensors see black the pod will exit this function. This function does not have any arguments or return any values.
  • straight() – travel straight through node
When pod received straight instruction, it will call straight() function to travel straight through node. This function turned on both wheels to continue forward until either Left and Right, LLeft and Left and RRight, or LLeft and Right and RRight see white on track. This function does not have any arguments or return any values.
  • turnRight() – Pod turn right at node
This function was used to turn the pod right. If the instruction from the queue was a right turn, this function is called. AMUX and BMUX are set to high to select the mux to turn right. It terminated right turn with either LLeft and Left sensor saw white or LLeft and Right sensor saw white.
  • station() – station stop
When pod is at the end of its journey, it will stop at a station. This function will select RC mode. This function does not have any arguments or return any values.
  • SWmode() – special case
In the case where LLeft, Middle, and RRight see white and Left and Right saw black, this function went straight for a short amount of time for the pod to get out of this reading. This function does not have any arguments or return any values.
  • tickFunction() – tick interrupt
This function occured when RRight sensor sensed a tick on the track. This function sent a binary semaphore called ticks_sem to wireless.


Wireless Task

This task is responsible for communicating between the master computer (laptop) and the state machine. Currently, this task is responsible for supplying the state machine with the new destination scheduled by the master computer. It is also responsible for sending the master computer regular updates on the pod’s location as it traverses the track. Communication is done via a wireless SNAP module (RF) with the master computer. The SNAP RF2466PC1 module uses UART to communicate with the control system and relay new messages received. The wireless task on the SJONE was programmed using C++, while the RF2466PC1 script as well as the portal script were written using Python and snappy script. Key features:

  • Updated time - updates the RTC of the pods SJONE with the current time from the master.
  • Register - registers the pod with the master before the pod can change operate.
  • Update - the pod sends the current location, tick count, current destination, and time since last tick to the master.
  • Get Destination - the pod requests a new destination from the master based on current location.

Testing & Technical Challenges

Track Design

Design Constraints

The design constraints for this project were: initially, there was no track to test the software on. The solution was to create a pod that would follow a black line on paper. This made building the track simple and cheap. The main goal was to make the pods intelligently follow the track.

Design Problems and Challenges

During the first test phases of the line follower, a white flexible mat was used as a track and black electrical tape was used as the line. However, the tape stretched and caused the mat to have ripples in it. When the pod traveled over the ripples, it needed a certain amount speed to travel over the bump. If the speed was too fast, the pod would go off track. Another problem was the tape on the track. When the pod made a right turn, it went off track. The electrical tape was black but it still had a little of reflection. A less reflective tape was tested and improved slightly. Non-reflective tape was also tested but did not improve the performance of the pod turning right and continuing straight.

Design Solutions and Trade-Offs

Since the first design track mat had problems with the ripples, another track was made using particle board and the same tape. This allowed the pod to go slower and lower the chances of the pod getting off track.

Testing

With every new track design the pod were placed on the track and we observed how will it followed.

Line Following

Design Constraint

The pod needed to follow a black line accurately and consistency. The pod also needed to follow the line through intersections and maintain a knowledge of it's position on the track.

Design Problems and Challenges

The component that was the most difficult to design program were the pod’s movements on the track. The parts purchased were very inexpensive and caused difficulties later in making the pod more accurate. Using a RC circuit to have the pod follow the line was simple and reliable but lacked intelligence to turn left or right. Using software to control the pod to follow the line became a challenge because it was not responsive enough to follow the line once additional tasks were implemented on the SJONE.

Design Solutions and Trade-Offs

Software controlling the line following was slower than the hardware. Hardware was used to control the line following, and software for the decision making at each node. The hardware followed the line decently but software could have made it more intelligent in following the line. The design could have been improved by implementing PID, but this work was not pursued because the main focus of this project was to build a control system, not a line follower. The line follower was used only to provide a visual for our software-based control system. The solution was to us the RC circuit to follow the track most of the time, and at intersections let the SJONE take over driving. This allowed for the pod to be responsive when traveling the track, and intelligent when navigating intersections.

Testing

This was tested by running the pods using only RC, only software, and finally with both software and RC.

Determining Location

Design Constraint

  • The pod needs to send an update periodically to the master
  • The master needs to knows where the pod is and its status
  • Update only when needed, and as infrequent as possible.
  • The pods needs to know its location.

Design Problems and Challenges

  • Tracking the pods location accurately was difficult due to the small area the track was operating. This made GPS, and triangulation impossible due to low resolution.
  • Sending updates infrequently makes the master less up to date.
  • Sending updates to frequently makes the network noisy and slow.

Design Solutions and Trade-Offs

  • Tick marks were placed on the track to determine location.
  • The pod also tracks its location along the graph and can send this to the master.
  • When ever a tick mark it reached the pod sends and updated to the master.
  • Position resolution is only as accurate as the number of tick marks used.
  • Updates only happen if a ticks is reached, and this depends on the movements of the pod.
  • The pod sometimes misses ticks due to its inconsistent movements.

Testing

This was tested by running the pods on the track and check for received data on the master's end.

IR Interference

Design Constraint

  • The pods need to be able to properly operate even with external IR interference.

Design Problems and Challenges

  • When outdoors at the Maker Fair 2014, the pods couldn't read the line correctly due to interference from the sun.
  • Pods lost the track and moved randomly.

Design Solutions and Trade-Offs

  • A mask of black tape was placed around the IR sensors to prevent external IR from hitting the sensors.

Testing

After tape was applied the pods were placed back on the track. If the pods continued to miss the line, more tape was added.

Conclusion

Taking part in the Spartan Superway project as part of the Controls sub-team was a great experience for us. While the focus of our project was mainly on the software side of the control system, we did have the opportunity to work with Mechanical Engineering students in other parts of the project including work done on an alternative control system for a 1/12th scale model of our track and a 1/12th Scale model of the pods (vehicles) that run on a rail, see figures below.


One of the biggest challenges in our design was having the line follower interface with the rest of the system components. Having an understanding of how FreeRTOS manages multiple tasks during operation was critical to having the system operate properly. Very early on in the project, it was decided that the system would take advantage of the shared queues concept to do communication between various tasks. Surprisingly, getting the pods to seem autonomous was the easy part. The path generating algorithm, Dijkstra, was fairly straight forward to use and very easy to interface with the rest of our system.

This project also enabled our members to learn more about writing serial bus drivers, using a real-time operating system, working with wireless communications, and algorithms that enable autonomous control. As mentioned earlier, we contributed to a much larger SJSU project called the Spartan Superway and this project was just the initial step in creating a fully autonomous transit network. There is much more that must be done going forward. For example, there is a need for collision avoidance protocols in the system, this can be achieved by allowing the pods in the system to communicate and determine which has the right of away. Alternatively, a master computer could oversee the operation of the entire network and decide which pods have the right of way at a junction.

We concluded our project by having the opportunity to present as part of an exhibit at Maker Faire in San Mateo on May 17th and 18th. It was both exciting and rewarding as many of our audiences were thoroughly impressed by the amount of work the SJSU Engineering students accomplished. The control’s team had attracted the most attention and it was often the case that the audiences came to our demo first. This project was a great way to end our SJSU college careers as it encompassed a majority of the topics learned in the Computer Engineering program, and it really tested our abilities to work as part of a team of multi-disciplinary engineering students.


Project Video

Upload a video of your project and post the link here.

Project Source Code

Send me your zipped source code and I will upload this to SourceForge and link it for you.

References

Acknowledgement

We would like to give thanks to the following people for their contributions towards the project.

  • Preet Kang: For teaching us about the FreeRTOS and various serial communication busses that became the basis of our project.
  • Keith Perry: Our project advisor, without whom we may not have known about this project. Also, for pushing us to be the best that we can be.
  • Marjo Mallari: Another member of our Senior Project group, she worked on our path generating algorithm (Dijkstra).
  • Cory Ostermann: Mechanical Engineering student who worked closely with us on the 1/12th Scale Model implementation.
  • Barry Swenson: For providing us with an offsite location to work on the project.
  • Dr Furman (ME dept): For allowing us to join the Spartan Superway Project and guiding us throughout the process.
  • Ron Swenson, Bryan Burlingame, the rest of the Spartan Superway Team, and the various sponsors of our project, Thank You!