Difference between revisions of "S15: Multi-media Car"

Revision as of 04:34, 25 May 2015

Grading Criteria

Multi-media Car

Abstract

The aim of this project is to build a self-driving car which can automatically avoid big barriers and obstacles in its path.

Objectives & Introduction

Our main objective of our project is designing an autonomous car that can avoid obstacles and can also find its own path after the detour.

We can list our objectives as following:

1. Avoiding approaching obstacles in front of the car.

2. The car should be able to decide whether to turn left or right by measuring the obstacles on left and right side.

3. After making a successful turning, the car should find its original direction then get back to its previous path.

The car should work as the following picture.

Fig 1. Routing

Team Members & Responsibilities

• Zan Zhan
  • <role>
• Rohit Teja Maddula
  • <role>
• Mengchi Cheng
  • <role>
• Taowu Wen
  • <role>

Schedule

Parts List & Cost

Give a simple list of the cost of your project broken down by components. Do not write long stories here.

Design & Implementation

The design section can go over your hardware and software design. Organize this section using sub-sections that go over your design and implementation.

Hardware Design

Infrared Sensor

Fig 2. Infrared Sensor

The infrared sensor has three wires: Power, GND and Feedback. Power is supplied by the SJone board, and it has a common GND with SJone Board. Feedback remains high if there are no obstacles, whenever the car encounters some obstacles, it will drop to logic low. Thus, by detecting the falling edge of the Feedback PIN, we can use the infrared sensor to stop our car immediately.

Ultrasonic Sensor

Fig 3. Ultrasonic Sensor

The Ultrasonic sensor is powered by the H-bridge which has a +5V power supply. In the detecting task, three ultrasonic are triggered by the pulses that are sent by SJone Board. After receiving the pulses, the ultrasonic sensor will produce a period of logic high on its echo PIN. By detecting the length of this feedback signals, we can calculate the distance between the obstacles and our car.

H-bridge

Fig 4. H-bridge

H-bridge is used to control the motor and communicates with SJone Board. When the power supply of H-bridge is between 7-12V, one of its pin can be use as a 5V power supply. H-bridge has two sets of GPIOs to control different motors. Each set has two GIPOs, one for moving forward, another one is reversing.

Schematic

This is the overall schematic for our design.

Fig 5. Schematic

Hardware Interface

• Power circuit is a series of batteries, which provides 7.5V power supply.
• SJone Board is communicating with different sensors. Including sending trigger signals to ultrasonic sensors and getting feedbacks of those sensors.
• Infrared sensor is used to detect any obstacles in front of the car.
• Ultrasonic sensors are triggered by the high pulse sent by SJone Board and gives the feedback. We can get the distance between obstacles and the car by calculating the length of those feedbacks.

Software Design

• Creating interrupt functions for the infrared sensor.
• Creating different tasks for controlling the motor movement(such as stop, forward and turn left).
• Using semaphores to switch between different tasks.
• Creating those tasks and semaphores in main() and initiating several sensors.

Infrared Interrupt

The infrared interrupt is only enabled in the Run_forward task. Whenever the car meets any obstruction while moving forward, the interrupt will hang on the current task and change to different emergency task depending on the DIR flag.

If the DIR flag is 0, which means the car haven't made any turn, the interrupt task will send an item to the turning queue.

If the DIR flag is not 0, which means the car already made the turnings but the path is blocked by an unpredicted obstacle, the car will stop immediately until the obstacle disappear. .

   if(xSemaphoreTake(frontInfraredRay, 1))
        {
            MotorStop();//stop motor when ISR
            vTaskDelay(100);
            BMW.FrontSonic = GetSonicData_F();
            if (BMW.DIR == 0)
            {
                LPC_GPIOINT->IO2IntEnF &= ~InfraredRay ; // Disable Interrupt of P2_7
                LPC_GPIOINT->IO2IntClr |=  InfraredRay ; // Clear Interrupt of P2_7
                MotorForwardADJ(4);
                  if (BMW.FrontSonic < 20)
                    xQueueSend(H_CarDetect_Notify, &flag_block, 500);
                 else
                    xQueueSend(H_CarRunFW_Notify, &flag_block, 500);
            }
            else
            {
                BMW.Block = 1;
            }
        }

Ultrasonic detection

Fig 6. Ultrasonic_timing

As the left timing diagram shows, when receiving a trigger signal the ultrasonic sensor gives us a feedback.

We can using the formula in the user manual to calculate the distance.

uS / 58 = centimeters 
uS / 148 =inch; 
range = high level time * velocity (340M/S) / 2;

Heare are the code segment.

   FSonic_Trig.setLow();
        vTaskDelay(1);
        FSonic_Trig.setHigh();
        vTaskDelay(1);
        FSonic_Trig.setLow();   // sending trigger
        while(!FSonic_Echo.read());
        uptime_us = sys_get_uptime_us();
        while(FSonic_Echo.read());
        endtime_us = sys_get_uptime_us();
    time_count= endtime_us- uptime_us;  // calculate echo length
    Distance = time_count/58;

Detect&Turning task

Fig 7. Flow table

Fig 8. DIR Definition

The initial state of the car is forward.

Whenever the first interrupt happens, the car stops immediately and detects the surrounding environment.

Based on the feedback from those ultrasonic sensors, the car decides to turn left or right. During the turning process, the DIR flag which indicates the direction of the car is also set as corresponding values.

After the car successfully made its first turn, it switches between the forward task and the detecting task.

Depending on the DIR and the ultrasonic sensors' feedbacks, the car keeps moving until detour the obstacles.

Implementation

This section includes implementation, but again, not the details, just the high level. For example, you can list the steps it takes to communicate over a sensor, or the steps needed to write a page of memory onto SPI Flash. You can include sub-sections for each of your component implementation.

Testing & Technical Challenges

Describe the challenges of your project. What advise would you give yourself or someone else if your project can be started from scratch again? Make a smooth transition to testing section and described what it took to test your project.

Include sub-sections that list out a problem and solution, such as:

Our Issue #1

• Controlling the car to move straight forward

In order the find the original path, our design is required to follow the expected path. However, due to the deficiency of our motor and the unevenness of the ground, the car cannot go straight forward.

Solution

We tried to use MPU6050 Accelerometer and the acceleration sensor in SJone Board, but none of them works.

Our Issue #2

• The infrared sensor gives false feedback during the movement. When the car moves on a uneven surface, the shaking causes the disturbance.

Solution

We use the front ultrasonic sensor to double check the feedback from IR sensor to determine the accuracy of an obstacle.

Our Issue #3

• The car can not exactly turn at 90°

Depending on different surfaces, the wheel has different frictional force. The same turning function can not ensure the wheel will turn the same amount in different surfaces. Moreover, although two motors use the same turning function, the turning of different motors are slightly different from each other.

solution

Adjusting the turning function based on testing results.

Conclusion

Conclude your project here. You can recap your testing and problems. You should address the "so what" part here to indicate what you ultimately learnt from this project. How has this project increased your knowledge?

Project Video

https://youtu.be/GQ-st4swMtg

Project Source Code

• Sourceforge Source Code Link

References

Acknowledgement

Any acknowledgement that you may wish to provide can be included here.

References Used

List any references used in project.

Appendix

You can list the references you used.