Difference between revisions of "S14: Need For Speed"

Latest revision as of 22:48, 3 June 2016

NEED FOR SPEED..!!

Abstract

Icon for our Android App

This page contains design and implementation of our Embedded Software project, Need For Speed. It's about maneuvering an RC vehicle using the Acceleration Sensor in a smart phone. An Android Application is developed to transmit the Acceleration Sensor Signals to the vehicle via Bluetooth. The car is mounted with a Bluetooth module to receive data from the phone. And the acceleration and turning of the vehicle will be based on this data. The vehicle is also mounted with two Infrared Sensor modules for collision detection, one in the front and other in the rear.Detection of any obstacle in the vehicles path will bring the vehicle to a halt state immediately.

Introduction

In this project we are using JY-MCU Bluetooth module to be the wireless link between the smartphone and the battery powered RC vehicle. The Android application is developed to transmit a particular byte for every threshold value of the Acceleration Sensor i.e. when the phone is one byte for front tilt and another for back. This received byte is compared by the SJOne board with few predefined values and accordingly PWM signals are given to the motors.

The input of the IR sensors is connected to the hardware interrupts on the SJOne board, the interrupt subroutine will be called every time there is an obstacle in the path of the vehicle, this subroutine will in turn stop the vehicle.

Objectives

As this project is both software and hardware based, our objectives were as follows;

• Hardware Objectives
  • To achieve a constant 6V DC supply for the motors and 5V DC for the board from the battery.
  • To interface the motors to the SJOne board via L298 motor driver.
  • To calibrate the IR sensors to sense obstacle in 6" proximity.
• Software Objectives
  • To develop an Android application to send the data from Acceleration Sensor via Bluetooth.
  • To develop a FreeRTOS code to receive these signals and process them.
  • To develop a FreeRTOS code to send PWM sigal to the motor for variable speed.
  • To develop a FreeRTOS code to accept interrupt from the IR sensors and take actions accordingly.

Team Members & Responsibilities

• Amey Patil
  • Hardware Design
  • Free RTOS (Part 1: To interface motors and LPC1758 using PWM)
  • Free RTOS (Part 2: To configure the Bluetooth module)
• Siddhata Patil
  • Free RTOS (Part 3: To send and receive data between Bluetooth module and LPC1758)
  • Android Application(Part1: To send data from Android Phone to LPC1758)
  • Android Application(Part2: To send results of accelerometer sensor from Android Phone to LPC1758)

Schedule

Parts List & Cost

Design and Implementation

System Block Diagram

The above Block Diagram shows the overall implementation of the project. The accelerometer values (x, y, z) are used as an input by the android application. Depending on the instantaneous values, tilt will be determined. This tilt value will be provided to the Bluetooth for transmission. At the receiver, this tilt data will be received by the Bluetooth Module and provided to the LPC 1758 board via an UART channel. The on board processor will compare the received data with the stored values and generate PWM signals accordingly. The motor driver upon reception of this will driver the vehicle in the respective direction. We will see detailed explanation of the hardware and software in their respective sections.

Flowchart

Flowchart for the System

Hardware Interface

Let us understand the whole structure piece by piece.

1. LPC 1758 SJOne Board

This board was a part of our course on Embedded Software at San Jose State University. For more information on the SJOne board Click_me.

Power Supply Schematic.

2. Power Supply

We need to generate steady 5V supply for the board while 6V for the motors without any current limitation otherwise the motors will not give its optimum output. To our luck, LM7806 voltage regulators are also available in the market along with the LM7805. The circuit schematic is as shown in the figure above.

The total current requirement of the circuit is around 1Amp. If this much current is to be drawn through the regulators then we must make sure the heat generated is properly dissipated, so we use heat sink. Most of the current will be driven through the LM7806 regulator as it drives the motors hence, we made sure that it is not surrounded by any other component. As, the LM7805 regulator just drives the SJOne board and IR module, current flowing through it is around 100mA. Hence, this regulator won't heat as much as the other one.

Motor Driver Schematic.

3. L298 Motor Driver

You must be thinking why didn't I use L293D as it is best for 6V motors and much easy to interface. Well, one of our motor consumes 200mA of current, which makes the total current 800mA that too in no load conditions. With load it might have seared upto 1A. Now the maximum handling capacity of L293D is 1A while that of L298 is 2A. Hence, for safety reasons I went for L298 motor driver. The pin connect for this interface is as shown in the above figure. The functions of the pins are as follows;

IN1 receives 'PWM input for left motor +' from LPC 1758 and drives OUT1

IN2 receives 'PWM input for left motor -' from LPC 1758 and drives OUT2

IN3 receives 'PWM input for right motor +' from LPC 1758 and drives OUT3

IN4 receives 'PWM input for right motor -' from LPC 1758 and drives OUT4

SENSE A limits the current for Left Motor

SENSE B limits the current for Right Motor

VS: Supply voltage for the Motors

For more information on L298 Driver, Click_me.

IR Module Schematic.

4. IR module

The IR module we are using is custom made. It is is designed to output logic '1' if any obstacle is detected or else logic '0'. The output signal from the IR receiver is directly proportional to the amount of IR waves falling on it. Hence, the output voltage for an obstacle far from the receiver will be less than that of a closer object.

In any case this output is in millivolts hence, we gave it as an input to LM358 which is a dual op-amp IC. This op-amp is configured in comparator mode. When the input at the non-inverting terminal is higher than the threshold voltage provided to the inverting terminal, the op-amp will give a logic high output. Hence, the threshold voltage is inversely proportional to the distance of the obstacle. So we connected a potentiometer at the input of the threshold voltage by which we can vary the range of obstacle detection.

In the case of IR the sensitivity of the reciever is not sufficient to detect obstacle at a longer distance. We were able to acheive obstacle detection in 2 inches of proximity. If, you are looking for detection at a longer distance, we would suggest you to go for Ultrasonic sensor modules which can even give you the distance of the obstacle from the vehicle.

Figure shows the circuit schematic of the IR module. This is circuit for one of the IR module. Two such circuits are implemented for front and back.

Bluetooth Module

5. Bluetooth Module

The module has 4 pins labeled on the back, VCC, GND, TXD and RXD. You might buy a module with two more pins KEY and STATE but it won't matter if you leave them open. The controller which it is interfaced with considers it as an serial UART device. So make sure you connect the RX and TX of the controller with TXD and RXD of the bluetooth module respectively.

This module works best if you are running on 3.3V, in case you are working on TTL logic then you might use a voltage divider for proper operation of the module. According to the datasheet the VCC pin is capable to handle supply ranging from 3-6V so it is fine to give TTL logic supply but, do not give TTL logic signal to the RXD pin, it cannot take anything more than 3.3V, doing such will damage the pin and hence the module.

The communication for configuration of the module is based on AT commands. There is one command for every thing, to set the device name, set the pin, set the baud rate and much more. All you have to do is to save these AT commands in the form of string and send each byte serially to the module using a simple for loop. Initially the baud rate is set to 9600. Following table shows few of the AT commands which you may require.

Hardware Design

It was really a task to adjust all the above mentioned tasks on an 25cm * 15 cm chasis which is made of some paper mache material (less strength). The BOT weighs around a pound increasing the load on the motor drastically. The following image on left shows the BOT in the design stage while the one on the right is our final product.

Work in progress...

Android TA DA..!!

FreeRTOS Programming

In this section we will walk you through the source code for the SJOne board. Whenever a character is sent by the Bluetooth module, the UART interrupt handler code is executed. The code is as shown below.

   void UART3_IRQHandler()
   {
       Uart3::getInstance().handleInterrupt();
       Uart3::getInstance().getChar(&in, 10000);
       printf("%c", in);
       motion = in;
   }

As you can see above the data received from the Bluetooth module is stored in the motion variable. Make sure you declare the motion variable as volatile because in the main function we will be using it in an infinite while loop. Making it volatile will help the compiler understand that this variable is gonna get updated from some other source and it will compile it inside the while loop.

The following piece of code shows the initialization of the Port 2 pins P2.0, P2.1, P2.2, P2.3. Make sure you include the "lpc_pwm.hpp" before using this piece of code.

   void PWM_init(){
       PWM left_positive(PWM::pwm1, 50);   //P2.0 --> IN1
       PWM left_negative(PWM::pwm2, 50);   //P2.1 --> IN2
       PWM right_positive(PWM::pwm3, 50);  //P2.2 --> IN3
       PWM right_negative(PWM::pwm4, 50);  //P2.3 --> IN4
   }

Below mentioned are the controlling functions for the motors. The code is well commented, one look through will be enough for you to understand the code.

   void left_halt(){
       left_positive.set(0);
       left_negative.set(0);
   }
   
   void right_halt(){
       right_positive.set(0);
       right_negative.set(0);
   }
   
   void left_forward(float speed){
       if (LPC_GPIO2->FIOPIN & (1 << 7)){  // If front IR senses an obstacle.
           left_halt();
           right_halt();
       }
       else{
           left_positive.set(speed);
           left_negative.set(0);
       }
   }
   
   void left_reverse(float speed){
       if (LPC_GPIO2->FIOPIN & (1 << 6)){  // If rear IR senses an obstacle.
           left_halt();
           right_halt();
       }
       else{
           left_positive.set(0);
           left_negative.set(speed);
       }
   }
   
   void right_forward(float speed){
       if (LPC_GPIO2->FIOPIN & (1 << 7)){  // If front IR senses an obstacle.
           left_halt();
           right_halt();
       }
       else{
           right_positive.set(speed);
           right_negative.set(0);
       }
   }
   
   void right_reverse(float speed){
       if (LPC_GPIO2->FIOPIN & (1 << 6)){  // If rear IR senses an obstacle.
           left_halt();
           right_halt();
       }
       else{
           right_positive.set(0);
           right_negative.set(speed);
       }
   }

The main function which we defined is sufficiently long hence we are giving few cases off our code to give an idea, you can use the above functions according to your requirement. Make sure the character which you send from the smartphone for a particular inclination is declared for that particular direction in the main.

   int main(void)
   {
       LPC_GPIO2->FIODIR &= ~(1 << 7);     //Front IR as input.
       LPC_GPIO2->FIODIR &= ~(1 << 6);     //Rear IR as input.
   
       //INITIALIZED TO A HALT STATE
       left_halt();
       right_halt();
   
       Uart3::getInstance().init(9600, 64, 64);
   
       while(1){
              
           switch (motion){     
           case 'a': // halt
               left_halt();
               right_halt();
               break;
           case 'n': // forward, left speed -> 50 & right speed -> 50
               left_forward(50);
               right_forward(50);
               break;
           case 's': // forward, left speed -> 100 & right speed -> 100
               left_forward(100);
               right_forward(100);
               break;            
           case 'i': // reverse right turn, left speed -> 0 & right speed -> -50
               left_halt();
               right_reverse(50);
               break;
           default:
               left_halt();
               right_halt();
               break;
           }
       }
   
       return -1;
   }

Android App Developement Design

Bluetooth Pairing

Using Android SDK

In our Android Application our objective was to pair Bluetooth device on our phone with the Bluetooth module that we used with SJOne Board. For pairing of devices we used the search and scan method of Bluetooth devices instead of using IP address. Thus making it more User friendly. In the image on the right you can see how all the available Bluetooth connections show up when we start the application.

Once the pairing was done successfully we moved to the next step, which was designing of Controller for the RC Car. In this process we designed lots of controllers like remote based controller where, as you can see in the images, user can press buttons on the display to drive the BOT.

After the success in the first attempt we went for the joystick based approach where, as in the play station remote, you can swipe the joystick up and down to control the BOT.

Then finally, we went for what was our goal, motion controller, with the help of the in built Acceleration sensor of the android device. The device was calibrated to send one character for every threshold range. For example, send 'a' when the phone is held in proper viewing angle, for halt. Now when you incline the phone forward, send another character for forward motion, when you incline the phone backward, send another character for backward motion.

Sending character was opted because, it's easy to send one character than sending the values of x, y and z which are declared as float. Also, it's always efficient to send one byte (char) instead of 12 (float*3).

Joystic controller screen

Controller stage in Progress

Accelerometer Controller screen

Circled is our Android App

\

Android Application Developement

For Connection and Pairing of Devices, I have used the Bluetooth APIs available like Bluetooth Adapter, Bluetooth Device etc. To work with Bluetooth it is very important that you add Permissions in the Android Manifest.xml. The three permissions that I used were: 1. android.permission.INTERNET(not needed since first we were trying to work with IP adress and wifi) 2. android.permission.BLUETOOTH_ADMIN 3. android.permission.BLUETOOTH Here the Bluetooth Adapter is used as the first step to setup the Bluetooth connection and to verify if the bluetoothis supported or not. The Bluetooth Adapter is returned when we call static BluetoothAdapter.getDefaultAdapter(). Secondly, it is very important that you enable the Bluetooth and this is done by calling startActivityForResult(). According to your requirement you can either BluetoothAdapter.ACTION_REQUEST_ENABLE or BluetoothAdapter.ACTION_STATE_CHANGED. Third Task is the Discovery, for this we have to call startbtAdapter.startDiscovery(). Next Task is to scan the devices available for Pairing. This is done by BluetoothAdapter.ACTION_DISCOVERY_STARTED and BluetoothAdapter.ACTION_DISCOVERY_FINISHED. And if nothing is happening check if the Bluetooth is ON if not turnOnBT(). Next task is to pair the Devices. This is done by calling btAdapter.getBondedDevices(). This will return already paired devices with the Android Device you using. Next step is to connect the devices which are not already paired. These devices are paired by entering the password for the device. Next step is to initiate a Bluetooth Connection for sending the data. For this simply copy the code for "private class ConnectThread extends Thread" from the Bluetooth|Android Developer site. Final task is set the UUID to "00001101-0000-1000-8000-00805F9B34FB" and you are good to go.

Android App Package

In our Android App Package, CMPE_244_NEED_FOR_SPEED, we have developed two activities. Our first Activity is the MainActivity which searches all the Bluetooth Devices possibly available and pairs the one we click on. For this purpose we have used the scanning of devices method instead of the IP Address technique. Once the pairing is successful, it will go to the next activity which is JSActivity which sends charachters and integers via bluetooth to the SJOne Board. This different data are send with the help of accelerometer Sensor in the Android Device. This is done by tilting the device. These sensor values were calibrated using the code in JSActivity. For accelerometer results, we find values of x, y and z values. These values are thus converted into integers and send via Bluetooth. We have made many projects before, until we finalized this one. We also made one spare application, in which we had a joystick kind of controller. This was done using Android Widgets. But we liked the accelerometer android app more and decided to go with it. Thus for this app, we have two files in source folder, one is MainActivity.java and other is JSActivity.java. Their corresponding xml file were written in Relative Layout format. One is activity_main.xml and other is remote_active.xml. And finally in AndroidManifest we declare the MainActivity first and after that we declare the JSActivity.

Testing the Android Application

Testing on Hercules

The Testing was carried out by using the android device in developement mode. In this mode, we had enabled USB debugging which allowed us to run our Android Application directly on our Android Device, thus saving lot of our time due to the slow emulator. When the project was build successfully, the APK file was then transfered to another android device and thus double testing was carried out. After the Android Application was ready, it was time to test the interface of the hardware. For this, we had to first check whether the android device was able to send data to the SJOne Board via bluetooth. This was done by connecting the SJOne Board to the Laptop. The result were seen on Hercules. If you enlarge the image you can see various numbers which show a successfull sending of the data. We have conditions like Forward, Backward, Right, Left and Halt. Each one is assigned a different integer value as seen in the screenshot.

Technical Difficulties

• The very first Technical Difficulty that we faced was even if the Android App Project was building successfully, it was crashing after we tried going to the controller screen. We searched online for answers and figured out that we had a problem with initialisation. So we made the required changes in onCreate method from our MainActivity and thus the problem was solved.
• The second difficulty that we faced was that even if the devices are paired successfully, the JSActivity was not able to send data. This was happening because we first wrote a code such that the bluetooth connection was lost as soon as we switched to the next activity. Thus we modified our code and got our desired results.

Acknowledgement

We would like to thank our professor Preet. We appreciate him for the board which he has designed, it's very handy and fun to work on. To all the people who found this documentation helpful, always remember, "There is no such thing as magic. There is a reason behind everything, find the reason you will find the solution."

References

• Sourceforge source code link

Datasheets

• [1] Philips Semiconductors. LPC1758 datasheet
• [2] LM 7805 - http://www.fairchildsemi.com/ds/LM/LM7805.pdf
• [3] LM 7806 - http://www.fairchildsemi.com/pf/LM/LM7806.html
• [4] L298 - https://www.sparkfun.com/datasheets/Robotics/L298_H_Bridge.pdf

Links

• [1] Bluetooth Connectivity Thread - http://developer.android.com/guide/topics/connectivity/bluetooth.html
• [2] Joystick Controller Display Screen - http://code.google.com/p/mobile-anarchy-widgets/source/browse/#svn%2Ftrunk%2FWidgets%2Fsrc%2Fcom%2FMobileAnarchy%2FAndroid%2FWidgets%2FJoystick%253Fstate%253Dclosed
• [3] Bluetooth Pairing Lectures - http://www.youtube.com/watch?v=OTQHZ16q0Ik
• [4] L298 Motor Driver - http://blog.pennybuying.com/down/f/F815A.pdf
• [5] Bluetooth Module - http://mcuoneclipse.com/2013/06/19/using-the-hc-06-bluetooth-module/

Appendix

• [Project source code is available at SourceForge]
• [Project Demonstration Video]