Difference between revisions of "S23: X Æ A-13"
(→Parts List & Cost) |
(→Team Members & Responsibilities) |
||
(218 intermediate revisions by the same user not shown) | |||
Line 1: | Line 1: | ||
+ | [[File:NPSIT The Car.jpg|900px|thumb|right|The Car]] | ||
+ | [[File:Ezgif-4.gif|600px||thumb]] | ||
+ | [[File:Ezgif-4-f0672f668d.gif|600px||thumb]] | ||
+ | |||
== Project Title == | == Project Title == | ||
− | + | X Æ A-13 | |
<HR> | <HR> | ||
<BR/> | <BR/> | ||
+ | |||
== Abstract == | == Abstract == | ||
− | + | This report presents an overview of the technical progress made during the development of an autonomous RC car. The project involved comprehensive research, establishing a private git repository for version control, and procuring essential components such as CAN transceiver modules. Significant achievements included successful integration of ultrasonic sensors, compass module, and RPM sensor. The team successfully implemented obstacle avoidance algorithms, efficient GPS parsing, and precise PID control. Additionally, a mobile app was developed for real-time data visualization and control. Rigorous hardware testing and fine-tuning were conducted to ensure optimal performance. The report provides the technical advancements achieved in hardware-software integration and algorithm implementation for the successful development of the prototype. | |
=== Introduction === | === Introduction === | ||
− | The project was divided into | + | The project was divided into 5 modules: |
− | * Sensor | + | * Sensor Node |
− | * Motor | + | * Motor Node |
− | * | + | * Driver Node |
− | * Android | + | * Geo Controller Node |
+ | * Android Application | ||
=== Team Members & Responsibilities === | === Team Members & Responsibilities === | ||
− | |||
− | + | <center>[[File:Group 1 Photo.jpeg|500px|middle|Group Picture]]</center> | |
− | < | ||
− | |||
− | |||
− | + | The source code of our car can be found here: [https://gitlab.com/cmpe243_group_1_rc-car/sjtwo-c-cmpe-group-1-rc-car X Æ A-13 Gitlab Repository] | |
− | + | <BR/> | |
− | |||
− | + | {| class="wikitable" style="margin-left: 0px; margin-right: auto;" | |
− | + | |- style="vertical-align: top;" | |
− | + | ! colspan="5" style="background:#ffffff;" | | |
+ | |- | ||
+ | ! scope="col" style="text-align: center;" style="background:#ffff00;" | | ||
+ | Team Members | ||
+ | ! scope="col" style="text-align: center;" style="background:#ffff00;" | | ||
+ | Technical Roles | ||
− | * | + | |- |
− | + | |- style="vertical-align: top;" | |
− | * | + | ! scope="row" style="text-align: left;" | |
+ | * [https://www.linkedin.com/in/sharanrv/ Sharan Raghu Venkatachalam] | ||
+ | | style="text-align: left;" | | ||
+ | * <span style="color:#0000FF">Driver Node Owner</span> <br /> | ||
− | * | + | |- |
− | ** | + | |- style="vertical-align: top;" |
− | ** | + | ! scope="row" style="text-align: left;" | |
+ | * [https://www.linkedin.com/in/ninaad-mallapur-a69a03150/?originalSubdomain=in Ninaad Mallapur] | ||
+ | | style="text-align: left;" | | ||
+ | * <span style="color:#EE82EE">Motor Node Owner </span> <br /> | ||
+ | |||
+ | |- | ||
+ | |- style="vertical-align: top;" | ||
+ | ! scope="row" style="text-align: left;" | | ||
+ | * [https://www.linkedin.com/in/prabhat-kumar0220/ Prabhat Kumar] | ||
+ | | style="text-align: left;" | | ||
+ | * <span style="color:#008000">Sensor Node and Motor Node Co-Owner</span> | ||
+ | |- | ||
+ | |- style="vertical-align: top;" | ||
+ | ! scope="row" style=" text-align: left;" | | ||
+ | * [https://www.linkedin.com/in/iftiza-ahmed-1409001/ Iftiza Ahmed Shovon] | ||
+ | | style="text-align: left;" | | ||
+ | * <span style="color:#008000">Geological Node Owner </span> <br /> | ||
− | * | + | |- |
− | * | + | |- style="vertical-align: top;" |
− | * | + | ! scope="row" style="; text-align: left;" | |
+ | * [https://www.linkedin.com/in/tushara-ramesh15/ Tushara Ramesh] | ||
+ | | style=";text-align: left;" | | ||
+ | * <span style="color:#36c">Mobile App Owner</span> <br /> | ||
+ | * <span style="color:#EE82EE">Bluetooth Communication and LCD Display</span> <br /> | ||
− | + | |- | |
− | + | |} | |
− | + | <br /> | |
<HR> | <HR> | ||
<BR/> | <BR/> | ||
+ | |||
== Schedule == | == Schedule == | ||
Line 63: | Line 93: | ||
! scope="col"| Point of Contact | ! scope="col"| Point of Contact | ||
|- | |- | ||
− | ! scope="row"| <font color = " | + | ! scope="row"| <font color = "black">1 |
− | | | + | | 02/13/2023 |
− | | <font color = " | + | | <font color = "black">02/18/2023 |
| | | | ||
− | * <font color = " | + | * <font color = "black">Read previous years' projects, gather information, and discuss among the team members. |
− | * <font color = " | + | * <font color = "black">Create a private git fork for the RC car repository. |
− | * <font color = " | + | * <font color = "black">Decide and conclude a recurring team meeting schedule |
|<font color = "green">Completed | |<font color = "green">Completed | ||
− | | <font color = " | + | | <font color = "black">Team |
|- | |- | ||
− | ! scope="row"|<font color = " | + | ! scope="row"|<font color = "black">2 |
− | | <font color = " | + | | <font color = "black">02/19/2023 |
− | | <font color = " | + | | <font color = "black">02/22/2023 |
| | | | ||
− | * <font color = " | + | * <font color = "black">Order CAN transceiver modules |
| <font color = "green">Completed | | <font color = "green">Completed | ||
− | | <font color = " | + | | <font color = "black">Iftiza |
|- | |- | ||
− | ! scope="row"|<font color = " | + | ! scope="row"|<font color = "black">3 |
− | | <font color = " | + | | <font color = "black">03/03/2023 |
− | | <font color = " | + | | <font color = "black">03/10/2023 |
| | | | ||
− | * <font color = " | + | * <font color = "black">Research several RC Car for the target application |
− | * <font color = " | + | * <font color = "black">Purchase RC Car |
| <font color = "green">Completed | | <font color = "green">Completed | ||
− | |<font color = " | + | |<font color = "black">Sharan, Prabhat, Tushara |
|- | |- | ||
− | ! scope="row"|<font color = " | + | ! scope="row"|<font color = "black">4 |
− | | <font color = " | + | | <font color = "black">03/11/2023 |
− | | <font color = " | + | | <font color = "black">03/17/2023 |
| | | | ||
− | * <font color = " | + | * <font color = "black">Create a fork for our project repository. |
− | * <font color = " | + | * <font color = "black">Create a git flow process. Establish a process for merging into the master code repository. |
− | * <font color = " | + | * <font color = "black">Finalize the sensors and other hardware we need for the project. |
− | * <font color = " | + | * <font color = "black">Finalize the best available hardware based on the data collected. |
+ | * <font color = "black">To validate communication between CAN nodes via BUSMASTER. | ||
| <font color = "green">Completed | | <font color = "green">Completed | ||
− | | <font color = " | + | | <font color = "black">Team |
|- | |- | ||
− | ! scope="row"|<font color = " | + | ! scope="row"|<font color = "black">5 |
− | | <font color = " | + | | <font color = "black">03/18/2023 |
− | | <font color = " | + | | <font color = "black">03/21/2023 |
| | | | ||
− | ''' | + | '''[http://books.socialledge.com/books/industrial-applications-with-can-bus/page/lab-rc-car-infrastructure Work on the RC Car Infrastructure Task]''' |
− | * <font color = " | + | * <font color = "black">Interface ultrasonic sensors for sensor node |
− | * <font color = " | + | * <font color = "black">Set up the driver node and build the ecosystem for receiving/transmitting CAN messages |
− | * <font color = " | + | * <font color = "black">Develop a base obstacle avoidance logic |
− | * <font color = " | + | * <font color = "black">Set up the motor node and create a fake indication for left/right turn and forward/backward movement to the motor |
| <font color = "green">Completed | | <font color = "green">Completed | ||
| | | | ||
− | * <font color = " | + | * <font color = "black"> Team |
− | *<font color = " | + | * <font color = "black">Iftiza |
− | *<font color = " | + | * <font color = "black">Prabhat, Sharan |
− | *<font color = " | + | * <font color = "black">Sharan |
− | *<font color = " | + | * <font color = "black">Ninaad, Sharan |
|- | |- | ||
− | ! scope="row"| | + | ! scope="row"|<font color = "black">6 |
| 03/22/2023 | | 03/22/2023 | ||
| 04/04/2023 | | 04/04/2023 | ||
| | | | ||
− | ''' | + | '''[http://books.socialledge.com/books/industrial-applications-with-can-bus/page/lab-geo-controller Work on the Geo Controller Task]''' |
− | * <font color = " | + | * <font color = "black">Integrate and test the GPS parsing algorithm |
− | * <font color = " | + | * <font color = "black">Validate cross-communication on CAN bus across nodes |
− | * <font color = " | + | * <font color = "black">Hack the PWM signals from the remote to RF receiver |
− | * <font color = " | + | * <font color = "black">Generate the PWM sequence from SJTwo to make the servo and motor move left/right/forward/backward |
− | * <font color = " | + | * <font color = "black">Replace the fake motor actions with actual motor movements which are received from Driver node |
− | * <font color = " | + | * <font color = "black">Try decoding the RF data packets from the remote to RF receiver |
| | | | ||
− | + | <font color = "green">Completed | |
| | | | ||
− | + | * <font color = "black">Iftiza | |
− | * <font color = " | + | * <font color = "black">Team |
− | * <font color = " | + | * <font color = "black">Sharan, Prabhat |
− | * <font color = " | + | * <font color = "black">Sharan, Prabhat |
− | * <font color = " | + | * <font color = "black">Ninaad |
− | * <font color = " | + | * <font color = "black">Tushara |
− | * <font color = " | ||
|- | |- | ||
− | ! scope="row"| | + | ! scope="row"|7 |
− | | 04/ | + | | 04/05/2023 |
− | | 04/ | + | | 04/18/2023 |
+ | | | ||
+ | '''Work towards the Prototype 1 Task''' | ||
+ | * <font color = "black"> Upgrade obstacle avoidance algorithm | ||
+ | * <font color = "black"> Test obstacle avoidance practically (Sensor Node -> Driver -> Motor Node -> Tire movement) | ||
+ | * <font color = "black"> Integrate compass module | ||
+ | * <font color = "black"> Integrate RPM sensor | ||
+ | * <font color = "black"> Integrate LCD module | ||
+ | * <font color = "black"> Integrate ESP8266 module | ||
+ | * <font color = "black"> Integrate three other ultrasonic sensors | ||
+ | * <font color = "black"> Basic mobile app (Transmit data and display on LCD) | ||
+ | * <font color = "black"> Simple hardware setup {Power supply, robust CAN wiring, layout, wiring} | ||
+ | * <font color = "black"> Validate inter-node communication via CAN over the protoboard | ||
+ | * <font color = "black"> Thorough Code Review (MIA, Unit Tests, Dead Code,...) | ||
+ | * <font color = "black"> Vist J.J. Customs shop to fix the battery charging issue | ||
+ | | | ||
+ | <font color = "green"> Completed | ||
| | | | ||
− | * | + | * Team |
− | * | + | * <font color = "black">Sharan |
− | + | * <font color = "black">Ninaad, Sharan, Prabhat | |
+ | * <font color = "black">Sharan | ||
+ | * <font color = "black">Prabhat | ||
+ | * <font color = "black">Tushara | ||
+ | * <font color = "black">Tushara | ||
+ | * <font color = "black">Prabhat | ||
+ | * <font color = "black">Tushara | ||
+ | * <font color = "black">Iftiza | ||
+ | * <font color = "black">Team | ||
+ | * <font color = "black">Team | ||
+ | * <font color = "black">Sharan, Ninaad | ||
|- | |- | ||
− | ! scope="row"| | + | ! scope="row"|8 |
− | | 04/ | + | | 04/19/2023 |
− | | 04/ | + | | 04/25/2023 |
+ | |'''Work towards the Prototype 2 Task''' | ||
+ | * Order components ahead for the next task | ||
+ | * Fine tune obstacle avoidance algorithm to make smoother transitions | ||
+ | * Add GPS lock LED indicator | ||
+ | * Implement PID controller and ramp testing | ||
+ | * Design navigation algorithm | ||
+ | * Display compass heading on LCD/mobile app | ||
+ | * Video recording of above | ||
+ | | <font color = "green"> Completed | ||
| | | | ||
− | * | + | * Team |
− | * | + | * Sharan |
− | * | + | * Anyone |
− | + | * Ninaad, Prabhat | |
+ | * Iftiza | ||
+ | * Tushara | ||
+ | * Anyone | ||
|- | |- | ||
− | ! scope="row"| | + | ! scope="row"|9 |
− | | 04/ | + | | 04/20/2023 |
− | | | + | | 05/02/2023 |
+ | |'''Work towards the Prototype 3 Task''' | ||
+ | * Order components ahead for the next task | ||
+ | * Fine tune obstacle avoidance | ||
+ | * Display debug information on LCD (GPS, Sonar, Compass, Distance, Speed,...) | ||
+ | * Integrate Google Maps API on Mobile App | ||
+ | * Upgrade the navigation algorithm | ||
+ | * Setup critical LEDs for displaying MIA faults, GPS lock, sensor o/p | ||
+ | * Add emergency stop button in HW and mobile app | ||
+ | * Video recording of above | ||
+ | | <font color = "green">Completed | ||
| | | | ||
− | * | + | * Team |
− | * | + | * Sharan |
− | * | + | * Sharan, Tushara |
− | + | * Tushara | |
+ | * Iftiza | ||
+ | * Iftiza, Sharan | ||
+ | * Prabhat, Ninaad | ||
+ | * Anyone | ||
|- | |- | ||
− | ! scope="row"| | + | ! scope="row"|10 |
− | | | + | | 05/03/2023 |
− | | | + | | 05/09/2023 |
+ | |'''Work towards the Prototype 4 Task''' | ||
+ | * Order components ahead for the next task | ||
+ | * Fine-tune obstacle avoidance | ||
+ | * Mobile application to display destination, and start/stop buttons. Display real-time GPS, compass, and sensor values. | ||
+ | * Upgrade the navigation algorithm for running in a straight line | ||
+ | * Design PCB layout | ||
+ | * Fine-tune PID controller | ||
+ | * PCB printing and assembly | ||
+ | * Team demo at Engineering Building: Run the car from point A to point B | ||
+ | * Video recording of above | ||
+ | | <font color = "green">Completed | ||
| | | | ||
− | * | + | * Team |
− | * | + | * Sharan |
− | * | + | * Tushara |
− | + | * Iftiza | |
+ | * Prabhat, Sharan | ||
+ | * Ninaad, Prabhat | ||
+ | * Team | ||
+ | * Team | ||
+ | * Anyone | ||
|- | |- | ||
− | ! scope="row"| | + | ! scope="row"|11 |
− | | | + | | 05/10/2023 |
− | | | + | | 05/24/2023 |
+ | |'''Work towards the final demo''' | ||
+ | * Fine-tune obstacle avoidance | ||
+ | * Fine-tune mobile app | ||
+ | * Fine-tune LCD display | ||
+ | * 3D print and build the car body, painting, beautification,... | ||
+ | * Features to indicate reverse, obstacle detection, headlights, turn indicator | ||
+ | * Display ETA to destination | ||
+ | * Checkpoint navigation | ||
+ | * Video recording of above | ||
+ | | <font color = "green">Completed | ||
| | | | ||
− | * | + | * Sharan |
− | * | + | * Tushara |
− | * | + | * Sharan |
− | + | * Prabhat | |
+ | * Ninaad | ||
+ | * Iftiza | ||
+ | * Team | ||
+ | * Anyone | ||
|- | |- | ||
|- | |- | ||
− | ! scope="row"| | + | ! scope="row"|12 |
− | | | + | | 05/10/2023 |
− | | | + | | 05/26/2023 |
+ | |'''Project Wrap-up''' | ||
+ | * Finalize and complete missing document pieces in Wiki | ||
+ | * Decide on future car ownership and settle finances | ||
+ | * Team picture | ||
+ | | <font color = "green"> Completed | ||
| | | | ||
− | + | Team | |
− | |||
− | |||
− | |||
− | |||
|- | |- | ||
|} | |} | ||
Line 233: | Line 346: | ||
|- | |- | ||
! scope="row"| 5 | ! scope="row"| 5 | ||
− | | Ultrasonic | + | | Ultrasonic Sensor |
− | | | + | | Adafruit US 100[https://www.adafruit.com/product/4019] |
| 4 | | 4 | ||
| $48.69 | | $48.69 | ||
Line 240: | Line 353: | ||
! scope="row"| 6 | ! scope="row"| 6 | ||
| GPS Module | | GPS Module | ||
− | | | + | | Adafruit PA1616S [https://www.adafruit.com/product/746?gclid=Cj0KCQjwuLShBhC_ARIsAFod4fIqHNCT0jQ6H0jPOiQ7yktm3R2kscp3D1viEb2etO3GBPK69__GmJAaAi4zEALw_wcB] |
| 1 | | 1 | ||
− | | | + | | $32 |
|- | |- | ||
! scope="row"| 7 | ! scope="row"| 7 | ||
− | | Compass Module | + | | Compass Module |
− | | RobotShop [https://www.robotshop.com/products/tilt-compensated-magnetic-compass-cmps12] | + | | CMPS12 - RobotShop [https://www.robotshop.com/products/tilt-compensated-magnetic-compass-cmps12] |
| 1 | | 1 | ||
| $39.77 | | $39.77 | ||
|- | |- | ||
! scope="row"| 8 | ! scope="row"| 8 | ||
− | | LCD Module | + | | LCD Module |
− | | | + | | LCD1602 [https://www.amazon.com/GeeekPi-Character-Backlight-Raspberry-Electrical/dp/B07S7PJYM6] |
| 2 | | 2 | ||
| $12.02 | | $12.02 | ||
Line 261: | Line 374: | ||
<BR/> | <BR/> | ||
− | == | + | == Schematic == |
− | + | [[File:Schematic_XAEA-13.jpg|1150px]] | |
<br> | <br> | ||
<HR> | <HR> | ||
<BR/> | <BR/> | ||
+ | |||
== CAN Communication == | == CAN Communication == | ||
− | + | Here is a brief description for all the messages and signals: | |
+ | |||
+ | 1. '''CHKPT_GPS_POSITION (ID: 101)''': Message transmitted by the GEOLOGICAL node, containing the following signals: | ||
+ | - **CHKPT_GPS_LATITUDE_SCALED**: The latitude of a checkpoint location, in degrees. | ||
+ | - **CHKPT_GPS_LONGITUDE_SCALED**: The longitude of a checkpoint location, in degrees. | ||
+ | |||
+ | 2. **CURRENT_GPS_POSITION (ID: 102)**: Message transmitted by the GEOLOGICAL node, containing: | ||
+ | - **CURRENT_GPS_LATITUDE_SCALED**: The current latitude of the vehicle, in degrees. | ||
+ | - **CURRENT_GPS_LONGITUDE_SCALED**: The current longitude of the vehicle, in degrees. | ||
+ | |||
+ | 3. **GEO_STATUS (ID: 103)**: Message transmitted by the GEOLOGICAL node, containing: | ||
+ | - **GEO_STATUS_COMPASS_ANGLE**: The current compass angle of the vehicle, in degrees. | ||
+ | - **GEO_STATUS_BEARING_ANGLE_TO_DESTINATION**: The bearing angle from the vehicle to the destination, in degrees. | ||
+ | - **GEO_STATUS_DISTANCE_TO_DESTINATION**: The distance from the vehicle to the destination, in meters. | ||
+ | - **GEO_STATUS_BEARING_ANGLE_TO_CHKPT**: The bearing angle from the vehicle to the checkpoint, in degrees. | ||
+ | - **GEO_STATUS_DISTANCE_TO_CHKPT**: The distance from the vehicle to the checkpoint, in meters. | ||
+ | 4. **GEO_ANGLE_DELTA (ID: 104)**: Message transmitted by the GEOLOGICAL node, containing: | ||
+ | - **GEO_ANGLE_DIFF_TO_DEST**: The difference in angle between the vehicle's current direction and the direction to the destination, in degrees. | ||
+ | - **GEO_ANGLE_DIFF_TO_CHKPT**: The difference in angle between the vehicle's current direction and the direction to the checkpoint, in degrees. | ||
+ | |||
+ | 5. **GEO_LOCK (ID: 105)**: Message transmitted by the GEOLOGICAL node, containing: | ||
+ | - **GEO_LOCK_TO_DESTINATION**: A boolean signal indicating whether the vehicle is locked onto the destination. | ||
+ | |||
+ | 6. **SENSOR_SONARS (ID: 201)**: Message transmitted by the SENSOR node, containing: | ||
+ | - **SENSOR_SONARS_left/right/middle/rear**: The readings from sonar sensors located at left, right, middle, and rear positions, in centimeters. | ||
+ | |||
+ | 7. **DEST_GPS_POSITION (ID: 202)**: Message transmitted by the SENSOR node, containing: | ||
+ | - **DEST_GPS_LATITUDE_SCALED**: The latitude of the destination, in degrees. | ||
+ | - **DEST_GPS_LONGITUDE_SCALED**: The longitude of the destination, in degrees. | ||
+ | |||
+ | 8. **CAR_HEARTBEAT (ID: 203)**: Message transmitted by the SENSOR node, containing: | ||
+ | - **HEARTBEAT_DATA**: A boolean heartbeat signal indicating the operational status of the car. | ||
+ | |||
+ | 9. **MOTOR_CMD (ID: 302)**: Message transmitted by the DRIVER node, containing: | ||
+ | - **MOTOR_CMD_steer**: The command to the steering mechanism. | ||
+ | - **MOTOR_CMD_drive**: The command to the driving mechanism. | ||
+ | |||
+ | 10. **LCD_DATA_FROM_MOTOR_NODE (ID: 401)**: Message transmitted by the MOTOR node, containing: | ||
+ | - **RPM_SENSOR_SPEED**: The speed of the vehicle as measured by an RPM sensor, in kilometers per hour. | ||
+ | - **SERVO_PWM**: The PWM (Pulse Width Modulation) signal for the servo, as a percentage of maximum. | ||
+ | - **MOTOR_PWM**: The PWM signal for the motor, as a percentage of maximum. | ||
+ | |||
+ | 11. **DEBUG_CHK (ID: 901)**: Message transmitted by the GEOLOGICAL node, containing debug information: | ||
+ | - **GPS_PASS_COUNTER**: The count of successful GPS operations. | ||
+ | - **GPS_FAIL_COUNTER**: The count of failed GPS operations. | ||
+ | - **CMPS_PASS_COUNTER**: The count of successful compass operations. | ||
+ | - **CMPS_FAIL_COUNTER**: The count of failed compass operations. | ||
+ | |||
+ | Each message and signal listed above contains additional data points like bit size, start position, byte order, value type, scaling factor, offset, minimum, maximum, and unit. These data points determine how to interpret the raw signal values from the CAN bus. | ||
=== Hardware Design === | === Hardware Design === | ||
− | + | [[File:Can.drawio.png|500px]] | |
=== DBC File === | === DBC File === | ||
− | + | [https://gitlab.com/cmpe243_group_1_rc-car/sjtwo-c-cmpe-group-1-rc-car/-/blob/master/dbc/project.dbc Gitlab link to the X Æ A-13 DBC file] | |
− | < | + | <pre> |
+ | VERSION "2.5" | ||
+ | |||
+ | NS_ : | ||
+ | BA_ | ||
+ | BA_DEF_ | ||
+ | BA_DEF_DEF_ | ||
+ | BA_DEF_DEF_REL_ | ||
+ | BA_DEF_REL_ | ||
+ | BA_DEF_SGTYPE_ | ||
+ | BA_REL_ | ||
+ | BA_SGTYPE_ | ||
+ | BO_TX_BU_ | ||
+ | BU_BO_REL_ | ||
+ | BU_EV_REL_ | ||
+ | BU_SG_REL_ | ||
+ | CAT_ | ||
+ | CAT_DEF_ | ||
+ | CM_ | ||
+ | ENVVAR_DATA_ | ||
+ | EV_DATA_ | ||
+ | FILTER | ||
+ | NS_DESC_ | ||
+ | SGTYPE_ | ||
+ | SGTYPE_VAL_ | ||
+ | SG_MUL_VAL_ | ||
+ | SIGTYPE_VALTYPE_ | ||
+ | SIG_GROUP_ | ||
+ | SIG_TYPE_REF_ | ||
+ | SIG_VALTYPE_ | ||
+ | VAL_ | ||
+ | VAL_TABLE_ | ||
+ | |||
+ | BS_: | ||
+ | |||
+ | BU_: GEOLOGICAL SENSOR DRIVER MOTOR | ||
+ | |||
+ | BO_ 101 CHKPT_GPS_POSITION: 8 GEOLOGICAL | ||
+ | SG_ CHKPT_GPS_LATITUDE_SCALED : 0|32@1- (1,0) [-90000000|90000000] "degree" DRIVER | ||
+ | SG_ CHKPT_GPS_LONGITUDE_SCALED : 32|32@1- (1,0) [-180000000|180000000] "degree" DRIVER | ||
+ | |||
+ | BO_ 102 CURRENT_GPS_POSITION: 8 GEOLOGICAL | ||
+ | SG_ CURRENT_GPS_LATITUDE_SCALED : 0|32@1- (1,0) [-90000000|90000000] "degree" DRIVER | ||
+ | SG_ CURRENT_GPS_LONGITUDE_SCALED : 32|32@1- (1,0) [-180000000|180000000] "degree" DRIVER | ||
+ | BO_ 103 GEO_STATUS: 8 GEOLOGICAL | ||
+ | SG_ GEO_STATUS_COMPASS_ANGLE : 0|10@1+ (1,0) [0|359] "degree" DRIVER | ||
+ | SG_ GEO_STATUS_BEARING_ANGLE_TO_DESTINATION : 10|10@1+ (1,0) [0|359] "degree" DRIVER | ||
+ | SG_ GEO_STATUS_DISTANCE_TO_DESTINATION : 20|16@1+ (1,0) [0|2000] "meter" DRIVER | ||
+ | SG_ GEO_STATUS_BEARING_ANGLE_TO_CHKPT : 36|10@1+ (1,0) [0|359] "degree" DRIVER | ||
+ | SG_ GEO_STATUS_DISTANCE_TO_CHKPT : 46|16@1+ (1,0) [0|2000] "metre" DRIVER | ||
+ | BO_ 104 GEO_ANGLE_DELTA: 4 GEOLOGICAL | ||
+ | SG_ GEO_ANGLE_DIFF_TO_DEST : 0|16@1- (1,0) [-359|359] "degree" DRIVER | ||
+ | SG_ GEO_ANGLE_DIFF_TO_CHKPT : 16|16@1- (1,0) [-359|359] "degree" DRIVER | ||
+ | |||
+ | BO_ 105 GEO_LOCK: 1 GEOLOGICAL | ||
+ | SG_ GEO_LOCK_TO_DESTINATION : 0|8@1+ (1,0) [0|1] "boolean" DRIVER | ||
+ | |||
+ | BO_ 201 SENSOR_SONARS: 5 SENSOR | ||
+ | SG_ SENSOR_SONARS_left : 0|10@1+ (1,0) [0|1000] "cm" DRIVER | ||
+ | SG_ SENSOR_SONARS_right : 10|10@1+ (1,0) [0|1000] "cm" DRIVER | ||
+ | SG_ SENSOR_SONARS_middle : 20|10@1+ (1,0) [0|1000] "cm" DRIVER | ||
+ | SG_ SENSOR_SONARS_rear : 30|10@1+ (1,0) [0|1000] "cm" DRIVER | ||
+ | |||
+ | BO_ 202 DEST_GPS_POSITION: 8 SENSOR | ||
+ | SG_ DEST_GPS_LATITUDE_SCALED : 0|32@1- (1,0) [-90000000|90000000] "degree" GEOLOGICAL,DRIVER | ||
+ | SG_ DEST_GPS_LONGITUDE_SCALED : 32|32@1- (1,0) [-180000000|180000000] "degree" GEOLOGICAL,DRIVER | ||
+ | |||
+ | BO_ 203 CAR_HEARTBEAT: 1 SENSOR | ||
+ | SG_ HEARTBEAT_DATA : 0|8@1+ (1,0) [0|1] "boolean" DRIVER | ||
+ | |||
+ | BO_ 302 MOTOR_CMD: 3 DRIVER | ||
+ | SG_ MOTOR_CMD_steer: 0|8@1- (1,-5) [-5|5] "" MOTOR | ||
+ | SG_ MOTOR_CMD_drive : 8|16@1- (1,-9) [-9|9] "kph" MOTOR | ||
+ | |||
+ | BO_ 401 LCD_DATA_FROM_MOTOR_NODE: 3 MOTOR | ||
+ | SG_ RPM_SENSOR_SPEED: 0|6@1+ (1,0) [0|50] "kph" DRIVER | ||
+ | SG_ SERVO_PWM: 6|7@1+ (1,0) [0|100] "percent" DRIVER | ||
+ | SG_ MOTOR_PWM: 13|7@1+ (1,0) [0|100] "percent" DRIVER | ||
+ | |||
+ | BO_ 901 DEBUG_CHK: 8 GEOLOGICAL | ||
+ | SG_ GPS_PASS_COUNTER: 0|16@1+ (1,0) [0|64000] "count" DRIVER | ||
+ | SG_ GPS_FAIL_COUNTER: 16|16@1+ (1,0) [0|64000] "count" DRIVER | ||
+ | SG_ CMPS_PASS_COUNTER: 32|16@1+ (1,0) [0|64000] "count" DRIVER | ||
+ | SG_ CMPS_FAIL_COUNTER: 48|16@1+ (1,0) [0|64000] "count" DRIVER | ||
+ | |||
+ | CM_ BU_ DRIVER "The driver node of the car"; | ||
+ | CM_ BU_ MOTOR "The motor controller node of the car"; | ||
+ | CM_ BU_ SENSOR "The sensor controller node of the car"; | ||
+ | CM_ BU_ GEOLOGICAL "The geoposition and geodirection controller of the car"; | ||
+ | CM_ BO_ 101 "Sync message used to synchronize the controllers from driver node"; | ||
+ | CM_ BO_ 102 "Sync message used to synchronize the controllers from sensor node"; | ||
+ | CM_ SG_ 101 DRIVER_HEARTBEAT_cmd "Heartbeat command from the driver"; | ||
+ | </pre> | ||
<HR> | <HR> | ||
<BR/> | <BR/> | ||
− | |||
− | |||
+ | == '''Sensor ECU''' == | ||
+ | [[File:WhatsApp_Image_2023-05-26_at_21.59.19.jpg|500px]] | ||
+ | |||
+ | [https://gitlab.com/cmpe243_group_1_rc-car/sjtwo-c-cmpe-group-1-rc-car/-/tree/master/projects/node_sensor node_sensor GitLab] | ||
+ | |||
+ | [[File:4019-02.jpg|300px|thumb|US-100]] | ||
+ | [[File:HC-05.jpg|300px|thumb|HC-05]] | ||
=== Hardware Design === | === Hardware Design === | ||
+ | |||
+ | [[File:Untitled_Diagram.drawio.png]] | ||
+ | |||
+ | '''Adafruit US-100 Ultrasonic Range Finder''' | ||
+ | *Detection Range(reliable): 2 cm to 250 cm. | ||
+ | *3-5V operation range. | ||
+ | *UART Output, PWM output. | ||
+ | *Accuracy: 3mm | ||
+ | *Measuring angle covered: <15° | ||
+ | *Operating Current: <15mA | ||
+ | *Operating Frequency: 40Hz | ||
+ | |||
+ | |||
+ | '''HC-05 Bluetooth Module''' | ||
+ | *Bluetooth version: 2.0 + EDR (Enhanced Data Rate) | ||
+ | *Frequency: 2.4 GHz ISM band | ||
+ | *Modulation: GFSK (Gaussian Frequency Shift Keying) | ||
+ | *Transmit power: Class 2 (up to 4 dBm) | ||
+ | *Sensitivity: -80 dBm typical | ||
+ | *Range: approximately 10 meters (or 33 feet) in open air | ||
+ | *Profiles supported: SPP (Serial Port Profile), HID (Human Interface Device) and others | ||
+ | *Operating voltage: 3.3V to 5V DC | ||
+ | *Operating current: less than 50mA | ||
+ | *Standby current: less than 2.5mA | ||
+ | *Sleep current: less than 1mA | ||
+ | *Interface: UART (Universal Asynchronous Receiver/Transmitter) | ||
+ | *Baud rates: 1200, 2400, 4800, 9600, 19200, 38400, 57600, 115200, 230400, and 460800 | ||
+ | *Operating temperature: -20°C to 75°C (-4°F to 167°F) | ||
+ | |||
+ | |||
+ | We employed a set of four Adafruit US-100 Ultrasonic Range Finders as sensory components in our project. These ultrasonic sensors were integrated into the RC car system with the objective of enabling effective obstacle avoidance. To achieve this, we strategically positioned three sensors on the front side of the RC car, while the remaining sensor was placed at the rear. | ||
+ | The sensors were powered by a +5V supply voltage. An indicative sign of successful data retrieval was the toggling of LED3 on the SJ2 board. | ||
+ | |||
+ | The operational principle is as follows: When the trigger pin is set to a HIGH state for a minimum duration of 10 microseconds, the module automatically emits a 40 kHz ultrasonic wave from the Ultrasonic transmitter. This wave propagates through the air and, upon encountering an obstruction, it reflects back towards the sensor. The Ultrasonic receiver module detects this reflected wave. As soon as the wave returns, the Echo pin becomes HIGH for a specific duration, equivalent to the time it took for the wave to travel back to the sensor. | ||
+ | |||
+ | for UART: To establish communication with the sensor, a UART baud rate of 9600 is utilized. In UART mode, a command is sent by transmitting the hexadecimal value 0x55 to the sensor. Following the command transmission, two bytes (a 16-bit value) are read back, representing the distance in millimeters (mm). | ||
+ | |||
+ | The SJ2 board measures the length of time during which the Echo pin remains HIGH, providing information about the duration of the wave's round trip. Utilizing this information, the distance is calculated, as described in the previous section. The formula used to measure the distance to the object is Distance = Speed × Time, where the speed represents the speed of sound. | ||
=== Software Design === | === Software Design === | ||
− | < | + | Among these sensors, two employed UART communication to transmit distance data to the SJ2 microcontroller, whereas the other two utilized interrupt-based communication. To facilitate communication with the SJ2 microcontroller, UART1 and UART3 were designated for the right and left sensors, respectively. Additionally, pins P0.6 and P0.7 were allocated as trigger pins, while pins P2.0 and P2.1 served as echo pins for the front and rear sensors. UART2 is being used for communication with HC-05 module. |
+ | |||
+ | Sensors were divided into two groups: | ||
+ | * Front and Rear | ||
+ | * Left and Right | ||
+ | |||
+ | Each group utilizes a frequency of 10Hz. The provided code demonstrates its periodic invocation. | ||
+ | <syntaxhighlight lang="cpp"> | ||
+ | void periodic_callbacks__10Hz(uint32_t callback_count) { | ||
+ | get_sonar_values(); | ||
+ | if ((ultrasonic_can_tx()) && (car_heartbeat_tx_10hz()) && (destination_coordinate_tx_10hz())) { | ||
+ | gpio__toggle(board_io__get_led3()); | ||
+ | } | ||
+ | </syntaxhighlight lang="cpp"> | ||
+ | |||
+ | The following code snippet demonstrates the initialization of the triggers for the front and rear sensors in 100Hz. | ||
+ | <syntaxhighlight lang="cpp"> | ||
+ | void periodic_callbacks__100Hz(uint32_t callback_count) { | ||
+ | ultrasonic_implementation__initiate_ultrasonics_range(); | ||
+ | } | ||
+ | </syntaxhighlight> | ||
+ | |||
+ | The following code snippet demonstrates the communication with the bluetooth/app: | ||
+ | |||
+ | <syntaxhighlight lang="cpp"> | ||
+ | void periodic_callbacks__1Hz(uint32_t callback_count) { | ||
+ | bool return_val = false; | ||
+ | return_val = get_app_data_1hz(); | ||
+ | if (return_val) { | ||
+ | gpio__toggle(board_io__get_led2()); | ||
+ | } | ||
+ | } | ||
+ | </syntaxhighlight> | ||
=== Technical Challenges === | === Technical Challenges === | ||
− | + | *''' Issue:''' The presence of noise in the sensor measurements is causing instability in the car's steering, resulting in a wobbly motion. | |
+ | *''' Solution:''' To address the issue of noise in the sensor measurements and stabilize the car's steering, we have implemented an average buffer. This buffer calculates the average value based on the last 10 readings rather than relying on a single value. By taking into account multiple readings over a period of time, the average buffer helps to reduce the impact of noise and provide a more stable steering response for the car. | ||
<HR> | <HR> | ||
<BR/> | <BR/> | ||
+ | |||
== Motor ECU == | == Motor ECU == | ||
<Picture and link to Gitlab> | <Picture and link to Gitlab> | ||
+ | |||
+ | The primary function of this module involves establishing a communication interface with the Driver Node, employing the CAN (Controller Area Network) communication protocol. Through this communication protocol, the module receives and retrieves the desired speed and steering angle information from the Driver Node. The CAN protocol facilitates the exchange of data between the module and the Driver Node, enabling seamless transmission of control signals for speed and steering angle adjustments. | ||
+ | |||
+ | Motors work on the PWM (pulse width modulation) values which are given by the ESC. ESCs process input signals, convert them into digital values, use algorithms to determine motor speed, generate PWM signals with variable pulse width, calculate duty cycle, and drive motors through power transistors to control speed. Understanding these PWM values for motor movements is a critical task which has to be done when we start working on the project. | ||
=== Hardware Design === | === Hardware Design === | ||
+ | |||
+ | ====Schematics==== | ||
+ | |||
+ | [[File:Motor main schematics.jpeg]] | ||
+ | |||
+ | [[File:Motor pinouts Hardware.png]] | ||
+ | |||
+ | The SJTwo board provided us with the necessary PWM pins, specifically P2.1 and P2.0, to which we connected the servo and DC motor, respectively. These pins were selected based on their capability to generate PWM signals required for precise control of the motors. | ||
+ | |||
+ | The SJTwo board is equipped with a powerful microcontroller, offering ample processing power and I/O capabilities. With its PWM functionality, we were able to modulate the output signals to control the servo and DC motor with high precision. | ||
+ | |||
+ | ====RPM Sensor==== | ||
+ | |||
+ | In our project, we have incorporated a Hall effect RPM sensor for monitoring the rotational speed of the vehicle's wheels. The RPM sensor is strategically positioned on the car's chassis, adjacent to the shock absorbers. This placement ensures accurate measurement of the wheel's rotational speed. The RPM sensor serves as a vital input for maintaining a consistent speed of the vehicle. | ||
+ | |||
+ | <div style="overflow: auto;"> | ||
+ | <div style="float: left; margin-right: 10px;"> | ||
+ | [[File:RPM sensor.jpeg|300px|thumb|center|RPM sensor placement]] | ||
+ | </div> | ||
+ | <div style="float: left;"> | ||
+ | [[File:Hall sensor.png|300px|thumb|center|RPM sensor]] | ||
+ | </div> | ||
+ | </div> | ||
+ | |||
+ | The RPM data obtained from the sensor is utilized by a PID (Proportional-Integral-Derivative) controller to regulate and fine-tune the vehicle's speed. By continuously monitoring the RPM, the PID controller makes necessary adjustments to ensure the vehicle maintains the desired speed. The RPM sensor acts as a critical source of speed information, enabling the PID controller to effectively and dynamically govern the vehicle's speed to achieve the desired stability and control. | ||
+ | |||
+ | ==== Hacking the RF Module ==== | ||
+ | |||
+ | In order to make the RC car autonomous, we faced the challenge of eliminating the need for the remote control typically used to operate the car. Our specific model, the Maverick Quantum MT, did not have its PWM (Pulse Width Modulation) sequence readily available in open-source form. Therefore, we had to delve into the process of detecting the PWM signals transmitted by the RC receiver to the Electronic Speed Controller (ESC) module. | ||
+ | |||
+ | To accomplish this, we employed an oscilloscope or a logic analyzer. However, we found that the logic analyzer was particularly advantageous due to its user-friendly interface and software capabilities for analyzing the obtained signals. By connecting the logic analyzer to the RC car's receiver, we were able to capture and analyze the PWM signals in detail. | ||
+ | |||
+ | Through the analysis, we were able to identify important parameters of the PWM signals, such as the duty cycle and frequency. These parameters corresponded to various actions performed by the servo and motor in the RC car. By understanding the relationship between these parameters and the desired actions, we gained the ability to replicate and control these actions autonomously, effectively replacing the functionality of the remote control. | ||
+ | |||
+ | This process of detecting and interpreting the PWM signals was essential for enabling autonomous control of the RC car. It allowed us to develop a custom control system that could replicate the desired actions based on the analyzed PWM signals. With this system in place, the RC car became capable of executing predefined maneuvers and tasks without relying on manual input from a remote control. | ||
+ | |||
+ | Overall, the utilization of an oscilloscope or logic analyzer, along with the analysis of PWM signals, played a crucial role in our endeavor to make the RC car autonomous. By gaining insights into the PWM parameters and implementing a custom control system, we were able to take control of the car's functions and pave the way for autonomous operation. | ||
+ | |||
+ | Here are the data we obtained | ||
+ | |||
+ | {| class="wikitable" | ||
+ | |- | ||
+ | ! scope="col"| Control Unit | ||
+ | ! scope="col"| Direction | ||
+ | ! scope="col"| Frequency (Hz) | ||
+ | ! scope="col"| Duty Cycle (%) | ||
+ | |- | ||
+ | ! scope="row"|Servo Motor | ||
+ | | Right Max | ||
+ | | 61.02 | ||
+ | | 5.9 | ||
+ | |- | ||
+ | ! scope="row"| | ||
+ | | Left Max | ||
+ | | 61.02 | ||
+ | | 12.62 | ||
+ | |- | ||
+ | ! scope="row"|Motor | ||
+ | | Forward Max Speed | ||
+ | | 61.02 | ||
+ | | 12.65 | ||
+ | |- | ||
+ | ! scope="row"| | ||
+ | | Idling (Zero) Speed | ||
+ | | 61.02 | ||
+ | | 9.27 | ||
+ | |- | ||
+ | ! scope="row"| | ||
+ | | Reverse Max Speed | ||
+ | | 61.02 | ||
+ | | 5.66 | ||
+ | |} | ||
+ | |||
+ | The duty cycle for crawling the car at the slowest speed = '''9.47%'''. | ||
=== Software Design === | === Software Design === | ||
− | < | + | The motor node code has been meticulously structured into multiple modules, showcasing a robust implementation of modularization principles. This approach enhances code organization, readability, and maintainability. The core section of the code encompasses the motor driver logic, precisely defining the motor's response in the presence of obstacles or impediments. By encapsulating this functionality, the code remains focused and comprehensible, facilitating future updates and modifications. |
+ | |||
+ | The codebase has been segregated into distinct files, each serving a specific purpose. One such file handles the RPM-related operations, enabling precise control and monitoring of the motor's rotational speed. Another file is dedicated to the implementation of the proportional-integral-derivative (PID) control, governing the motor's behavior based on feedback and error correction. This separation of concerns ensures modularity, allowing developers to modify or enhance specific aspects without disrupting the overall functionality. | ||
+ | |||
+ | A separate code base is devoted to the initialization process, streamlining the configuration of GPIO (General Purpose Input/Output) and PWM (Pulse Width Modulation) channels associated with the motor. This modularized initialization file provides a clear overview of the motor-related setup, making it easier to manage and maintain. | ||
+ | |||
+ | ==== Periodic Callback Functions ==== | ||
+ | <b>Periodic Callback: Init</b><br> | ||
+ | - The CAN bus is initialized <br> | ||
+ | - The RPM sensor interrupts are initialized.<br> | ||
+ | - The Motor and servo PWM signals are initialized and set to default values. <br> | ||
+ | <b>Periodic Callback: 1Hz</b><br> | ||
+ | - The motors start-up sequence is designed. <br> | ||
+ | <b>Periodic Callback: 10Hz</b><br> | ||
+ | - Decode the driving speed and steering sent by the Driver node after reading all CAN messages. <br> | ||
+ | |||
+ | ====Motors Startup sequence==== | ||
+ | <pre> | ||
+ | void run_once_motor_startup_sequence(uint32_t callback_count, bool *test_flag){ | ||
+ | static float test_duty_cycle = 9.84; | ||
+ | static bool run_once = true; | ||
+ | if (run_once) { | ||
+ | if ((callback_count > 1) && (test_duty_cycle <= 10)) { | ||
+ | pwm1__set_duty_cycle(PWM1__2_0, test_duty_cycle); | ||
+ | test_duty_cycle += 0.3f; | ||
+ | if (test_duty_cycle >= 10) { | ||
+ | *test_flag = true; | ||
+ | run_once = false; | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | </pre> | ||
+ | |||
+ | The run_once_motor_startup_sequence function is designed to perform an initial motor startup sequence. It takes two parameters: callback_count, which represents the number of callbacks, and test_flag, a boolean pointer. | ||
+ | |||
+ | Within the function, a duty cycle value is gradually incremented until it reaches 10. During each iteration, the duty cycle is set using the pwm1__set_duty_cycle function. Once the duty cycle reaches 10, the test_flag is set to true, indicating that the motor startup sequence is complete. This flag can then be used as a trigger to start reading CAN messages or perform other actions in the code. | ||
+ | |||
+ | ====Code Flow==== | ||
+ | |||
+ | When motor_cmd->MOTOR_CMD_drive is 1: | ||
+ | The motor gradually accelerates to a target speed of 8.5 kph using the compute_and_set_motor_pwm function. | ||
+ | The speed is controlled by adjusting the PWM duty cycle, specifically using the motor_fwd_slow_speed_pwm value. | ||
+ | |||
+ | When motor_cmd->MOTOR_CMD_drive is 0: | ||
+ | The motor enters a hard stop braking state, indicated by setting the PWM duty cycle to motor_hard_stop_braking. | ||
+ | |||
+ | When motor_cmd->MOTOR_CMD_drive is -1: | ||
+ | The motor enters reverse mode, with the PWM duty cycle set to motor_reverse_speed. | ||
+ | |||
+ | When motor_cmd->MOTOR_CMD_drive is 7: | ||
+ | The motor is set to a neutral position, maintaining a constant speed using the motor_neutral_pwm value. | ||
+ | |||
+ | When motor_cmd->MOTOR_CMD_steer is -1: | ||
+ | The motor is steered slightly to the left using the turn_slight_left PWM duty cycle. | ||
+ | |||
+ | When motor_cmd->MOTOR_CMD_steer is -2: | ||
+ | The motor is turned fully to the left using the turn_full_left PWM duty cycle. | ||
+ | |||
+ | When motor_cmd->MOTOR_CMD_steer is 2: | ||
+ | The motor is turned fully to the right using the turn_full_right PWM duty cycle. | ||
+ | |||
+ | When motor_cmd->MOTOR_CMD_steer is 1: | ||
+ | The motor is steered slightly to the right using the turn_slight_right PWM duty cycle. | ||
+ | |||
+ | These control actions enable precise control of the motor's speed and steering, allowing it to respond to different drive and steer commands. The PWM duty cycles determine the motor's behavior, ensuring smooth acceleration, deceleration, and controlled steering angles based on the input commands. | ||
+ | |||
+ | <b>Why did we choose to follow this above approach ?</b> | ||
+ | |||
+ | <b>Modularity and Readability:</b> The code is organized into separate functions, each handling specific motor control tasks. This modular structure enhances code readability, making it easier to understand and maintain. By isolating different functionalities, it promotes code reusability and scalability. | ||
+ | |||
+ | <b>Flexibility and Extensibility:</b> The code incorporates well-defined variables and constants, such as motor_fwd_slow_speed_pwm, motor_hard_stop_braking, and turn_slight_left. By using these parameters, it becomes effortless to fine-tune the motor's behavior without modifying the core logic. This flexibility enables easy adjustment of speed, braking, and steering parameters based on specific requirements. | ||
+ | |||
+ | <b>Controlled Acceleration and Braking:</b> The code implements gradual acceleration and deceleration techniques through the go_to_neutral_gradually and go_to_reverse_gradually functions. This controlled approach ensures smooth transitions between different speed states, enhancing safety and stability during motor operations. | ||
+ | |||
+ | <b>Real-time Feedback:</b> The code utilizes variables like current_kph and target_kph to monitor the motor's speed and provide real-time feedback. By continuously assessing the current speed and adjusting the PWM duty cycle accordingly, the code can dynamically regulate the motor's behavior to maintain the desired target speed. | ||
+ | |||
+ | <b>Consistent and Predictable Steering:</b> By associating specific PWM duty cycles with various steering commands, such as turn_slight_left and turn_full_right, the code ensures consistent and predictable steering behavior. This allows for accurate maneuvering and navigation control of the motor. | ||
+ | |||
+ | ====PID Implementation==== | ||
+ | |||
+ | <pre> | ||
+ | double pid_controller_compute_value(double setpoint, double input_speed) { | ||
+ | |||
+ | double error = setpoint - input_speed; | ||
+ | double proportional = Kp * error; | ||
+ | integral += Ki * error * dt; | ||
+ | double derivative = Kd * (error - last_error) / dt; | ||
+ | double output = proportional + integral + derivative; | ||
+ | last_error = error; | ||
+ | |||
+ | return output; | ||
+ | } | ||
+ | </pre> | ||
+ | |||
+ | The function pid_controller_compute_value takes in the setpoint (the desired target value) and the input speed as parameters. It calculates the error by subtracting the input speed from the setpoint. The proportional term (proportional) is computed by multiplying the error by the proportional gain (Kp), representing the immediate response to the error. The integral term accumulates the error over time, as the error is multiplied by the integral gain (Ki) and the time increment (dt), and added to the integral variable. The derivative term (derivative) considers the rate of change of the error, calculated by multiplying the difference between the current and last errors by the derivative gain (Kd), and dividing by the time increment (dt). | ||
+ | |||
+ | The output of the PID controller is obtained by summing the proportional, integral, and derivative terms. The last error is stored for reference in the next iteration. The resulting output is returned by the function. | ||
+ | |||
+ | This implementation allows the PID controller to dynamically adjust the control output based on the error and its rate of change, enabling effective control and regulation of the system | ||
=== Technical Challenges === | === Technical Challenges === | ||
− | < | + | <b>1. Understanding the startup sequence</b> |
+ | |||
+ | The electronic speed controller (ESC) incorporates a specific startup sequence that must be followed in order to initiate and activate the motors. Failure to replicate this sequence accurately will result in the inability to start the motors. Determining this startup sequence requires a significant investment of time and effort. To understand and replicate the sequence, we continuously analyze the PWM (pulse width modulation) values transmitted by the remote control. By carefully studying the data and observing the pattern of PWM values, we can develop a code that mimics the exact sequence in our own programming. During this process, a logic analyzer proves to be immensely valuable. It assists us in navigating through the complexities of the startup sequence, providing insights and facilitating the accurate replication of the required PWM values in our code. The logic analyzer enables us to effectively analyze and interpret the timing and patterns of the PWM signals, aiding in the successful implementation of the ESC's startup sequence. | ||
+ | |||
+ | <b>2. Making the reverse work properly</b> | ||
+ | |||
+ | To ensure proper reverse operation, we implemented a synchronization mechanism between the rear sensor data and control commands. By aligning and correlating these inputs, we achieved controlled and seamless transitions between forward and reverse motion. This synchronization played a crucial role in preventing unintended movements and facilitating effective maneuvering around obstacles. The careful coordination of rear sensor data and control commands enabled us to maintain control and achieve reliable reverse operation while ensuring a smooth transition back to normal forward motion. | ||
+ | |||
<HR> | <HR> | ||
<BR/> | <BR/> | ||
+ | |||
== Geographical Controller == | == Geographical Controller == | ||
− | + | [https://gitlab.com/cmpe243_group_1_rc-car/sjtwo-c-cmpe-group-1-rc-car/-/tree/master/projects/node_geological/l5_application/periodics geo_node] | |
+ | |||
+ | In today's technologically advanced world, navigation has become an indispensable part of peoples lives. Whether exploring unfamiliar territories or simply trying to find way through a bustling city, reliable and accurate navigation systems have become paramount. Among the various advancements in this field, one remarkable innovation is the development of Automatic GEO navigation, which combines the power of GPS (Global Positioning System) and compass sensor technology. This groundbreaking fusion enables users to effortlessly navigate their surroundings, ensuring precise location tracking and directional guidance. | ||
+ | |||
+ | For this feature development in the project two standard GPS and COMPASS sensor were selected after a thorough market research. The following sensors are more reliable and easier from the perspective of data extraction. | ||
+ | |||
+ | |||
+ | '''GPS module | ||
+ | |||
+ | [[File:Adafruit_ultimate_GPS.jpg]] | ||
+ | ''' Adafruit Ultimate GPS Breakout Board; interacts in UART 9600 BAUD_RATE | ||
+ | |||
+ | |||
+ | '''COMPASS module | ||
+ | |||
+ | [[File:CMPS12_pre_calibrated.jpg]] | ||
+ | ''' Tilt Compensated Magnetic COMPASS (CMPS12) from BOSCH; interacts in I2C | ||
+ | |||
+ | |||
+ | '''GEO_NODE_Sketch with MS_VISIO | ||
+ | [[File:GEO_NODE_Schematic.jpg]] | ||
+ | ''' Pin Diagram for the GEO Node with SJ2 Board and CAN_bus | ||
=== Hardware Design === | === Hardware Design === | ||
+ | |||
+ | Both the GPS sensor and the COMPASS sensor has to be powered from a specific required voltage level and they require specific amount of current to response accurately. For that a reliable design is a must. First of all the board interaction pin were decided based on the communication bus required to interact with these sensors. According to that a rough sketch was made to have a reference. Then finally with all the sensors, SJ2 board and for ECU communication CAN transceiver's connection were generated in a Schematic design tool for future reliable hardware design (noise free). Sensor signals are very sensitive to noise levels. | ||
+ | |||
+ | '''Schematic Design (GEO_NODE) | ||
+ | |||
+ | [[File:GEO_NODE_Hardware_archi.jpg]] | ||
+ | ''' Hardware architecture for GEO_NODE with SJ2 Board and CAN_bus | ||
=== Software Design === | === Software Design === | ||
− | < | + | GEO_NODE code modules have organized sections for better user readability. It has the following code modules low level to high level: |
+ | myQeue, line_buffer, gps, compass, coordinate_calculation, waypoints, can_initialize, can_tx, can_rx | ||
+ | |||
+ | To have a understanding on the total GEO NODE development; these module plays a great deal. GPS module gives bunch of sets of serial line from where we need to extract a special line for our coordinate. For that we need a good buffer. That's why a circular queue based buffer was used via line_buffer & myQueue modules. These were pre designed in the course lab sessions and here it is re-touched for GPS parsing with good unit tests. | ||
+ | |||
+ | |||
+ | '''GPS Extraction''' | ||
+ | |||
+ | GPS module gives couple of NMEA data in 1Hz rate. We are storing those lines in line buffer and from that line buffer we extract only the required line that we are looking for. And when we have the line we call the gps_parsing API to get that coordinate and store in GPS_coordinate structure to store it. a sniff of the GPS parsign is given below: | ||
+ | |||
+ | <syntaxhighlight lang="cpp"> | ||
+ | static bool gps__parse_coordinates_from_line(gps_coordinates_t *parsed_coordinates) { | ||
+ | bool return_val = false; | ||
+ | char gps_NMEA_read_line[512]; | ||
+ | char parse_string[16]; // Size 16 has no significant. This string is used as a temporary place to store parsed | ||
+ | // characters | ||
+ | char helper_string[4]; | ||
+ | uint8_t index = 0u; | ||
+ | |||
+ | memset(gps_NMEA_read_line, 0u, sizeof(gps_NMEA_read_line)); | ||
+ | |||
+ | while (line_buffer__remove_line(&line_buffer, gps_NMEA_read_line, sizeof(gps_NMEA_read_line))) { | ||
+ | index = 0u; | ||
+ | memset(parse_string, 0u, sizeof(parse_string)); | ||
+ | if (NEMA_DATA_TYPE_SIZE == | ||
+ | gps_parse_string(&gps_NMEA_read_line[index], parse_string)) // GPS parsing for NMEA data type | ||
+ | { | ||
+ | if ((parse_string[0] == '$') && (parse_string[1] == 'G') && (parse_string[2] == 'P') && | ||
+ | (parse_string[3] == 'G') && (parse_string[4] == 'G') && (parse_string[5] == 'A')) { | ||
+ | uint8_t size; | ||
+ | index = index + NEMA_DATA_TYPE_SIZE + 1u; | ||
+ | |||
+ | memset(parse_string, 0u, sizeof(parse_string)); | ||
+ | size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for Time (Dummy as not needed) | ||
+ | index = index + size + 1u; | ||
+ | |||
+ | memset(parse_string, 0u, sizeof(parse_string)); | ||
+ | size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for Lattitude | ||
+ | index = index + size + 1u; | ||
+ | if (size == LATTITUDE_SIZE) { | ||
+ | helper_string[0] = parse_string[0]; | ||
+ | helper_string[1] = parse_string[1]; | ||
+ | helper_string[2] = 0; | ||
+ | |||
+ | // Convert Lattitude from string to float | ||
+ | parsed_coordinates->latitude = | ||
+ | atof(helper_string) + (atof(&parse_string[2]) / 60.0); // Convert DD. // Convert MM | ||
+ | |||
+ | memset(parse_string, 0u, sizeof(parse_string)); | ||
+ | size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for lattitude sign | ||
+ | index = index + size + 1u; | ||
+ | if (size == 1u) { | ||
+ | if (parse_string[0] == 'S') { | ||
+ | parsed_coordinates->latitude = -parsed_coordinates->latitude; | ||
+ | } | ||
+ | |||
+ | memset(parse_string, 0u, sizeof(parse_string)); | ||
+ | size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for Longitude | ||
+ | index = index + size + 1u; | ||
+ | if (size == LONGITUDE_SIZE) { | ||
+ | helper_string[0] = parse_string[0]; | ||
+ | helper_string[1] = parse_string[1]; | ||
+ | helper_string[2] = parse_string[2]; | ||
+ | helper_string[3] = 0; | ||
+ | |||
+ | // Convert Longitude from string to float | ||
+ | parsed_coordinates->longitude = | ||
+ | atof(helper_string) + (atof(&parse_string[3]) / 60.0); // Convert DD. // Convert MM | ||
+ | |||
+ | memset(parse_string, 0u, sizeof(parse_string)); | ||
+ | size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for longitude sign | ||
+ | index = index + size + 1u; | ||
+ | if (size == 1u) { | ||
+ | if (parse_string[0] == 'W') { | ||
+ | parsed_coordinates->longitude = -parsed_coordinates->longitude; | ||
+ | } | ||
+ | return_val = true; | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | |||
+ | return return_val; | ||
+ | } | ||
+ | </syntaxhighlight> | ||
+ | |||
+ | A GPGGA message appears as follows (our target NMEA line from sensor): | ||
+ | |||
+ | Message Format: | ||
+ | $GPGGA,HHMMSS.SS,DDMM.MMMMM,K,DDDMM.MMMMM,L,N,QQ,PP.P,AAAA.AA,M,±XX.XX,M, SSS,RRRR*CC<CR><LF> | ||
+ | |||
+ | {| class="wikitable" width="auto" style="text-align: center; margin-left: auto; margin-right: auto; border: none;" | ||
+ | |+ GPGGA Format | ||
+ | |- | ||
+ | ! scope="col"| Message Component | ||
+ | ! scope="col"| Description | ||
+ | |- | ||
+ | | $GPGGA | ||
+ | | Message type indicator | ||
+ | |- | ||
+ | | HHMMSS.SS | ||
+ | | UTC time in hours, minutes, and seconds of the position | ||
+ | |- | ||
+ | | DDMM.MMMMM | ||
+ | | Latitude in degrees, minutes, and decimal minutes | ||
+ | |- | ||
+ | | K | ||
+ | | Latitude indicator; value is N (North latitude) or S (South latitude) | ||
+ | |- | ||
+ | | DDDMM.MMMMM | ||
+ | | Longitude in degrees, minutes, and decimal minutes | ||
+ | |- | ||
+ | | L | ||
+ | | Longitude indicator; value is E (East longitude) or W (West longitude) | ||
+ | |- | ||
+ | | N | ||
+ | | Quality indicator (indicates positional lock) | ||
+ | |- | ||
+ | | QQ | ||
+ | | Number of satellites used in position solution | ||
+ | |- | ||
+ | | PP | ||
+ | | Horizontal dilution of precision (HDOP) | ||
+ | |- | ||
+ | | A.A | ||
+ | | Antenna altitude, in meters, re: mean-sea-level (geoid) | ||
+ | |- | ||
+ | | M | ||
+ | | Units of antenna altitude (M = meters) | ||
+ | |- | ||
+ | | G.G | ||
+ | | Geoidal separation (in meters) | ||
+ | |- | ||
+ | | M | ||
+ | | Units of geoidal separation (M = meters) | ||
+ | |- | ||
+ | | SSS | ||
+ | | Age of differential corrections, in seconds | ||
+ | |- | ||
+ | | RRRR | ||
+ | | Differential reference station ID | ||
+ | |- | ||
+ | | *CC | ||
+ | | Checksum | ||
+ | |- | ||
+ | | <CR> | ||
+ | | Checksum | ||
+ | |- | ||
+ | | <LF> | ||
+ | | Carriage return | ||
+ | |- | ||
+ | |} | ||
+ | |||
+ | |||
+ | |||
+ | '''COMPASS Extraction''' | ||
+ | |||
+ | COMPASS sensor data extraction were way more simpler than GPS sensor. It interacted with the SJ2 board in I2C. Also it didn't need any calibration sequence as the CMPS12 itself calibrates the data and sends. | ||
+ | |||
+ | <syntaxhighlight lang="cpp"> | ||
+ | bool compass__read_heading(void) { | ||
+ | const uint8_t COMPASS_HEADING_BYTES = 2; | ||
+ | uint8_t received_raw_data[2] = {0}; | ||
+ | bool i2c_read_status = false; | ||
+ | |||
+ | i2c_read_status = i2c__read_slave_data(compass_i2c, CMPS12_SLAVE_ADDRESS_DEFAULT, CMPS12_RAW_BEARING_HIGH_BYTE_BOSCH, | ||
+ | received_raw_data, COMPASS_HEADING_BYTES); | ||
+ | |||
+ | if (i2c_read_status) { | ||
+ | compass_heading_degrees = ((float)(((uint16_t)received_raw_data[0] << 8) | ((uint16_t)received_raw_data[1]))) / | ||
+ | CMPS12_BOSCH_HEADING_SCALING_FACTOR; | ||
+ | } | ||
+ | |||
+ | return i2c_read_status; | ||
+ | } | ||
+ | |||
+ | float compass__get_heading_degrees(void) { return compass_heading_degrees; } | ||
+ | |||
+ | </syntaxhighlight> | ||
+ | |||
+ | |||
+ | '''Calculations for distances and bearing angle''' | ||
+ | |||
+ | For geo_algorithm we need to calculate the bearing angle from point A to point B to compare with the car's COMPASS also distance needs to be calculated. For this, IgIS map tool algorithm were used. These algorithm were verified from MATLAB and tested with reference coordinates and then finally implemented on SJ2 board. Below is the code sniff: | ||
+ | |||
+ | <syntaxhighlight lang="cpp"> | ||
+ | float coordinate_calculation__distance_meter(float latitude_current, float longitude_current, | ||
+ | float latitude_destination, float longitude_destination) { | ||
+ | if (abs(latitude_destination - (float)0.0) < (float)0.00000000001 && | ||
+ | abs(longitude_destination - (float)0.0) < (float)0.00000000001) { | ||
+ | return 0; | ||
+ | } | ||
+ | |||
+ | /* | ||
+ | Law of Haversine to calculate distance between two co-ordinate | ||
+ | Reference from iGisMAP tool | ||
+ | */ | ||
+ | float latitude_current_radian = (PI / ((float)180.0)) * latitude_current; | ||
+ | float longitude_current_radian = (PI / ((float)180.0)) * longitude_current; | ||
+ | |||
+ | float latitude_destination_radian = (PI / ((float)180.0)) * latitude_destination; | ||
+ | float longitude_destination_radian = (PI / ((float)180.0)) * longitude_destination; | ||
+ | |||
+ | float delta_laitude_radian = latitude_destination_radian - latitude_current_radian; | ||
+ | float delta_longitude_radian = longitude_destination_radian - longitude_current_radian; | ||
+ | |||
+ | float a = (sin(delta_laitude_radian / ((float)2.0)) * sin(delta_laitude_radian / ((float)2.0))) + | ||
+ | (cos(latitude_current_radian) * cos(latitude_destination_radian) * | ||
+ | sin(delta_longitude_radian / ((float)2.0)) * sin(delta_longitude_radian / ((float)2.0))); | ||
+ | float c = ((float)2.0) * ((float)atan2(sqrt(a), sqrt(1 - a))); | ||
+ | float distance_in_km = EARTH_RADIUS_IN_KM * c; | ||
+ | |||
+ | float distance_in_m = distance_in_km * ((float)1000.0); | ||
+ | |||
+ | return distance_in_m; | ||
+ | } | ||
+ | |||
+ | float coordinate_calculation__bearing_degree(float latitude_current, float longitude_current, | ||
+ | float latitude_destination, float longitude_destination) { | ||
+ | if (abs(latitude_destination - (float)0.0) < (float)0.00000000001 && | ||
+ | abs(longitude_destination - (float)0.0) < (float)0.00000000001) { | ||
+ | return 0; | ||
+ | } | ||
+ | |||
+ | /* | ||
+ | No bearing can happen without NORTH reference | ||
+ | Angle measured in clock-wise rotation | ||
+ | Reference from iGisMAP tool | ||
+ | */ | ||
+ | float latitude_current_radian = (PI / (float)180.0) * latitude_current; | ||
+ | float longitude_current_radian = (PI / (float)180.0) * longitude_current; | ||
+ | |||
+ | float latitude_destination_radian = (PI / (float)180.0) * latitude_destination; | ||
+ | float longitude_destination_radian = (PI / (float)180.0) * longitude_destination; | ||
+ | |||
+ | float delta_laitude_radian = latitude_destination_radian - latitude_current_radian; | ||
+ | float delta_longitude_radian = longitude_destination_radian - longitude_current_radian; | ||
+ | |||
+ | float x_radian = cos(latitude_destination_radian) * sin(delta_longitude_radian); | ||
+ | float y_radian = (cos(latitude_current_radian) * sin(latitude_destination_radian)) - | ||
+ | (sin(latitude_current_radian) * cos(latitude_destination_radian) * cos(delta_longitude_radian)); | ||
+ | |||
+ | float bearing_rad = atan2(x_radian, y_radian); | ||
+ | |||
+ | float bearing_deg = bearing_rad * ((float)180.0 / PI); | ||
+ | float bearing_deg_scaled_360 = (float)0.0; | ||
+ | |||
+ | if (bearing_deg < (float)0.0) { | ||
+ | bearing_deg_scaled_360 = ((float)360.0) + bearing_deg; | ||
+ | } else { | ||
+ | bearing_deg_scaled_360 = bearing_deg; | ||
+ | } | ||
+ | |||
+ | return bearing_deg_scaled_360; | ||
+ | } | ||
+ | |||
+ | bool coordinate_calculation__arrived(float latitude_current, float longitude_current, float latitude_destination, | ||
+ | float longitude_destination) { | ||
+ | float margin_of_error = 0.01; /* 10cm error margin to reach destination */ | ||
+ | |||
+ | float distance = coordinate_calculation__distance_meter(latitude_current, longitude_current, latitude_destination, | ||
+ | longitude_destination); | ||
+ | |||
+ | if (distance < margin_of_error) { | ||
+ | return true; | ||
+ | } else { | ||
+ | return false; | ||
+ | } | ||
+ | } | ||
+ | |||
+ | </syntaxhighlight> | ||
+ | |||
+ | |||
+ | '''Waypoint Algorithm''' | ||
+ | |||
+ | For waypoint algorithm a simple approach were used. We set some intermediary waypoint coordinates to go from point A to point B. We sniffed those intermediary points and followed towards destination. The destination was received from the BRIDGE controller. Bridge controller receives the coordinate from mobile app and sends to can_bus. GEO_NODE sniff that destination coordinate and stores to waypoint module to enable the path routing. | ||
+ | |||
+ | <syntaxhighlight lang="cpp"> | ||
+ | gps_coordinates_t find_closest_waypoint_coordinate(gps_coordinates_t current_coordinate, | ||
+ | gps_coordinates_t destination_coordinate) { | ||
+ | waypoints[4] = destination_coordinate; | ||
+ | |||
+ | float current_to_waypoint_distance = | ||
+ | coordinate_calculation__distance_meter(current_coordinate.latitude, current_coordinate.longitude, | ||
+ | waypoints[waypoint_index].latitude, | ||
+ | waypoints[waypoint_index].longitude); | ||
+ | if (current_to_waypoint_distance < 4.0f && (waypoint_index <= 3)) { | ||
+ | waypoint_index++; | ||
+ | } | ||
+ | |||
+ | return destination_coordinate; | ||
+ | } | ||
+ | |||
+ | </syntaxhighlight> | ||
+ | |||
+ | |||
+ | '''Periodic callback Flow''' | ||
+ | |||
+ | First all the modules are initialized and then the GPS and COMPASS modules care called for sensor extraction from a lower callback task and stored in a secured set points. Then for the can communication a comparative higher task were used to throw those angle and distance parameters to driver node for automatic hovering. | ||
+ | |||
+ | <syntaxhighlight lang="cpp"> | ||
+ | void periodic_callbacks__initialize(void) { | ||
+ | // This method is invoked once when the periodic tasks are created | ||
+ | const uint32_t can_baud_rate_kbps = 100U; | ||
+ | const uint16_t can_rx_q = 100U; | ||
+ | const uint16_t can_tx_q = 100U; | ||
+ | const can__num_e can_name = can1; | ||
+ | |||
+ | compass__initialize(); // Pin--> P0.10(I2C-2 SDA2), P0.11(I2C-2 SCL2) | ||
+ | gps__init(); // Pin--> P0.15(Uart-1 Tx), P0.16(Uart-1 Rx) | ||
+ | can_initialization(can_name, can_baud_rate_kbps, can_rx_q, can_tx_q); | ||
+ | if_can_bus_off__restart_can_bus(can_name); | ||
+ | destination_coordinate_rx(); | ||
+ | } | ||
+ | |||
+ | void periodic_callbacks__1Hz(uint32_t callback_count) { | ||
+ | bool return_val = false; | ||
+ | |||
+ | return_val = get_gps_sensor_1hz(); | ||
+ | |||
+ | if (return_val == true) { | ||
+ | gpio__toggle(board_io__get_led0()); | ||
+ | debug_gps_counter_pass++; | ||
+ | } else { | ||
+ | debug_gps_counter_fail++; | ||
+ | } | ||
+ | |||
+ | if (gps_lock_chk == true) { | ||
+ | gpio__reset(board_io__get_led3()); | ||
+ | } else { | ||
+ | gpio__set(board_io__get_led3()); | ||
+ | } | ||
+ | } | ||
+ | |||
+ | void periodic_callbacks__10Hz(uint32_t callback_count) { | ||
+ | bool return_val = false; | ||
+ | bool return_val1 = false; | ||
+ | |||
+ | return_val = get_compass_sensor_10hz(); | ||
+ | |||
+ | if (return_val == true) { | ||
+ | gpio__toggle(board_io__get_led1()); | ||
+ | debug_CMPS_counter_pass++; | ||
+ | } else { | ||
+ | debug_CMPS_counter_fail++; | ||
+ | } | ||
+ | |||
+ | return_val1 = destination_coordinate_rx(); | ||
+ | if (return_val1) { | ||
+ | chk_rcvd_gps_app = get_destination_coordinates(); | ||
+ | } | ||
+ | |||
+ | if ((chk_rcvd_gps_app.latitude > 0.0f) || (chk_rcvd_gps_app.latitude < 0.0f)) { | ||
+ | gps_lock_chk = true; | ||
+ | } else { | ||
+ | gps_lock_chk = false; | ||
+ | } | ||
+ | } | ||
+ | |||
+ | void periodic_callbacks__20Hz(void) { | ||
+ | bool ret_val1 = false; | ||
+ | bool ret_val2 = false; | ||
+ | bool ret_val3 = false; | ||
+ | bool ret_val4 = false; | ||
+ | bool ret_val5 = false; | ||
+ | |||
+ | get_waypoint_update_100hz(); | ||
+ | ret_val1 = geo_status_tx(); | ||
+ | ret_val2 = current_gps_position_tx(); | ||
+ | ret_val3 = chkpt_gps_position_tx(); | ||
+ | ret_val4 = geo_angle_delta_tx(); | ||
+ | |||
+ | if (gps_lock_chk) { | ||
+ | ret_val5 = geo_lock_tx(1); | ||
+ | } else { | ||
+ | ret_val5 = geo_lock_tx(0); | ||
+ | } | ||
+ | |||
+ | if (ret_val1 && ret_val2 && ret_val3 && ret_val4 && ret_val5) { | ||
+ | gpio__toggle(board_io__get_led2()); | ||
+ | } | ||
+ | |||
+ | debug_sensor_counter_tx(debug_gps_counter_pass, debug_gps_counter_fail, debug_CMPS_counter_pass, | ||
+ | debug_CMPS_counter_fail); | ||
+ | } | ||
+ | |||
+ | void periodic_callbacks__100Hz(uint32_t callback_count) { | ||
+ | if (callback_count % 5 == 0) { | ||
+ | periodic_callbacks__20Hz(); | ||
+ | } | ||
+ | } | ||
+ | |||
+ | </syntaxhighlight> | ||
+ | |||
+ | There are some extra counter found here, those will be explained in next section. | ||
=== Technical Challenges === | === Technical Challenges === | ||
− | + | Some debugging was needed for my GEO node. It was suspected that COMPASS & GPS were parsing but there might be some failure rate. So, some debug pass/fail counter were created for CAN_bus to check whether it is true or not. It was right and there were some issues with GPS parsing. There was almost 20% fail rate while parsing and found some issue with line-buffer development fixed that and with increased buffer size and the GPS parsing fail rate reduced to less than 1%. | |
<HR> | <HR> | ||
Line 326: | Line 1,267: | ||
<HR> | <HR> | ||
<BR/> | <BR/> | ||
− | == | + | |
+ | == Driver ECU == | ||
+ | |||
<Picture and link to Gitlab> | <Picture and link to Gitlab> | ||
+ | |||
+ | The driver node a.k.a the MCU for the MCUs is a critical unit that needs high importance. Since all the nodes will interact with driver node, it is important that CAN message reception and transmission is always operational in the desired manner. | ||
+ | |||
+ | The function of the driver node is to: | ||
+ | Run obstacle avoidance | ||
+ | Manage CAN reception and transmission of CAN bus data from all nodes | ||
+ | Interact with sensor data from other nodes and process the relevant data locally | ||
+ | Print and display diagnostic data on the LCD display | ||
=== Hardware Design === | === Hardware Design === | ||
+ | |||
+ | [[File:Driver Node Schematics.png]] | ||
+ | |||
+ | [[File:New LCD image1.png|500px|thumb|left|LCD]] | ||
=== Software Design === | === Software Design === | ||
− | |||
− | === | + | We carefully thought over what data needs to be sent and received over each of the periodic callbacks. It was ensured that there is not too much of an unnecessary overload high frequency callbacks as it may consume more than 1000 ms and force reboot the MCU. In our design, we used `periodic_callbacks__1Hz` for low priority operations, `periodic_callbacks__10Hz` for more critical operations, but not the most time sensitive applications such as sonar and compass sensing. At 10 Hz, we are reading out the GPS data that include the present location, distance to checkpoint, and distance to destination. In 20 Hz callback, we are reading out the compass and sonar sensor data. It was observed that the response rate of the car towards obstacle improved significantly when the sensors were read at atleast 20 Hz. Since our car was controlled to move to 8.5 km/hr, the reaction time of the car from an obstacle needs to be fast at this point in time. Hence, the driver node reads the data at 20 Hz periodic callbacks. |
+ | |||
+ | <pre> | ||
+ | void periodic_callbacks__20Hz(uint32_t callback_count) { | ||
+ | can__rx_20Hz(); | ||
+ | can_handler__manage_mia_20hz(); | ||
+ | DP__obstacle_avoidance_processor(get_decoded_sensor_data()); | ||
+ | can__tx_motor_commands_20Hz(); | ||
+ | } | ||
+ | </pre> | ||
+ | |||
+ | ====OBSTACLE AVOIDANCE==== | ||
+ | Obstacle avoidance is one of the most important aspect that enables the car to reach the destination. A robust obstacle avoidance algorithm enables the car to dodge the obstacle and move towards the destination in a smooth manner. If the car is made to turn right/left with maximum degree, then the car will make abrupt turns and make the obstacle avoidance less smoother. | ||
+ | |||
+ | To solve this issue, we added an intermediate left and right turn that lies in between a full turn and straight direction. | ||
+ | |||
+ | |||
+ | ====Obstacle Avoidance Logic==== | ||
+ | There is infinite possibilities for an obstacle to arrive while the car is in motion. It is impossible to hard-code the obstacle scenarios for obstacle avoidance. Therefore, a smart approach will be to use a truth table listing the possibilities of obstacle with respect to sensors. | ||
+ | |||
+ | [[File:Obstacle Avoidance Logic.png]] | ||
+ | |||
+ | <pre> | ||
+ | void DP__obstacle_avoidance_processor(const dbc_SENSOR_SONARS_s sensor_data) { | ||
+ | if (get_decoded_GEO_STATUS_data().GEO_STATUS_DISTANCE_TO_CHKPT < 2) { | ||
+ | stop_car_destination_reached(); | ||
+ | } else if (OA__is_obstacle_detected(sensor_data)) { | ||
+ | OA__run_obstacle_avoidance_algorithm(sensor_data); | ||
+ | } else { | ||
+ | OA__follow_destination(get_decoded_GEO_STATUS_data().GEO_STATUS_BEARING_ANGLE_TO_CHKPT - | ||
+ | get_decoded_GEO_STATUS_data().GEO_STATUS_COMPASS_ANGLE); | ||
+ | } | ||
+ | } | ||
+ | |||
+ | |||
+ | |||
+ | |||
+ | void OA__run_obstacle_avoidance_algorithm(const dbc_SENSOR_SONARS_s sensor_data) { | ||
+ | if (OA__is_middle_sonar_in_emergency_range(sensor_data)) { | ||
+ | ReverseAdd_7(); | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_LEFT; | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_BACKWARD; | ||
+ | can__tx_motor_commands_20Hz(); | ||
+ | reverse_flag = true; | ||
+ | } | ||
+ | |||
+ | |||
+ | else { | ||
+ | if (OA__is_middle_sonar_less_than_threshold(sensor_data) && | ||
+ | OA__is_left_and_right_sensors_less_than_threshold(sensor_data)) { | ||
+ | ReverseAdd_7(); | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_LEFT; | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_BACKWARD; | ||
+ | can__tx_motor_commands_20Hz(); | ||
+ | reverse_flag = true; | ||
+ | } | ||
+ | |||
+ | |||
+ | else if (OA__is_right_sonar_less_than_threshold(sensor_data) || | ||
+ | ((OA__is_right_sonar_less_than_threshold(sensor_data) && | ||
+ | OA__is_middle_sonar_less_than_threshold(sensor_data)))) { | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_LEFT; | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_FORWARD; | ||
+ | can__tx_motor_commands_20Hz(); | ||
+ | reverse_flag = false; | ||
+ | } | ||
+ | |||
+ | |||
+ | else if (OA__is_left_sonar_less_than_threshold(sensor_data) || | ||
+ | ((OA__is_left_sonar_less_than_threshold(sensor_data) && | ||
+ | OA__is_middle_sonar_less_than_threshold(sensor_data)))) { | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_RIGHT; | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_FORWARD; | ||
+ | can__tx_motor_commands_20Hz(); | ||
+ | reverse_flag = false; | ||
+ | } | ||
+ | |||
+ | |||
+ | else if (OA__is_left_sonar_less_than_threshold(sensor_data) && | ||
+ | OA__is_right_sonar_less_than_threshold(sensor_data)) { | ||
+ | ReverseAdd_7(); | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_steer = STEER_STRAIGHT; | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_BACKWARD; | ||
+ | can__tx_motor_commands_20Hz(); | ||
+ | reverse_flag = true; | ||
+ | } | ||
+ | |||
+ | |||
+ | else if (OA__is_middle_sonar_less_than_threshold(sensor_data)) { | ||
+ | if (sensor_data.SENSOR_SONARS_left > sensor_data.SENSOR_SONARS_right) { | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_LEFT; | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_FORWARD; | ||
+ | can__tx_motor_commands_20Hz(); | ||
+ | reverse_flag = false; | ||
+ | } else { | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_RIGHT; | ||
+ | processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_FORWARD; | ||
+ | can__tx_motor_commands_20Hz(); | ||
+ | reverse_flag = false; | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | } | ||
+ | |||
+ | </pre> | ||
− | + | ===Technical Challenges and Lessons Learnt - Advice to future students=== | |
− | + | Since the driver node is completely dependent on the sensors, firstly - it is important that the sensors are integrated and fixed as early as possible. | |
− | |||
− | |||
− | + | 1. In our case, since the sensors were not ready in the early weeks, we followed a completely TDD approach where we wrote the code along with the test cases. Since TDD is like a simulation of the algorithm, it gave us the confidence that the obstacle avoidance algorithm would work even without the sensors. So, use TDD as much as possible. | |
− | + | 2. Do not use hypothetical sensor threshold values. Take the car out, make it run and then decide what is the ideal threshold value. | |
+ | At early stages, while designing the algorithm we assumed that threshold of 50 cm would be sufficient for an obstacle avoidance. We soon realised, that the thresholds vary largely as it is directly proportional to the speed of the car. More the speed, larger the threshold. | ||
+ | |||
+ | 3. Obstacle avoidance is all about trial and error and practical testing. Get the sonars integrated as early as possible, and get the car running in the field. | ||
− | + | 4. LEDs are free, use it lavishly. Since driver node interacts with all other nodes, it becomes very difficult to debug and realise if the reception from and transmission to other nodes is successful from the driver’s perspective. It is difficult to always connect BusMaster just to detect if reception and transmission is working. Flashing a particular LED that is assigned to a particular node will quickly help in detecting the faulty node. | |
− | |||
− | + | 5. Use multiple thresholds - hard stop threshold and safe threshold to prevent the car from generalising all obstacles as one. Sometimes, a hard stop is needed when the obstacle is suddenly too close to the car. | |
− | |||
<HR> | <HR> | ||
<BR/> | <BR/> | ||
− | == Mobile Application == | + | |
+ | == Mobile Application [Tushara] == | ||
<Picture and link to Gitlab> | <Picture and link to Gitlab> | ||
Line 372: | Line 1,430: | ||
<HR> | <HR> | ||
<BR/> | <BR/> | ||
+ | |||
== Conclusion == | == Conclusion == | ||
− | + | This remote control (RC) project served as a canvas to showcase our problem-solving abilities and our adeptness in design. It required each team member to exemplify leadership qualities by independently managing their tasks and ensuring the effective operation of their modules, often with minimal supervision and scarce assistance. Emphasis was placed on the generation of clean code and comprehensive unit testing, along with the need for excellent design and composure during challenging circumstances. Collectively, we fulfilled the set expectations and successfully developed an autonomous electric vehicle, an accomplishment that fills us with immense pride. Our love for our craft and our pursuit of continual improvement became our most formidable asset throughout this journey. | |
− | + | Our autonomous electric vehicle was heavily influenced by models such as Silver Arrow and Road Runner. The integration of all modules via CANbus mirrored strategies adopted by renowned companies such as Ford, BMW, and Tesla, addressing our concerns related to signal integrity. The creation of the D.B.C file provided us with a profound understanding of the composition and transmission of CAN messages among the vehicle's modules. The development and integration of the Android mobile application shed light on wireless communication and the comparative advantages of Wi-Fi, Bluetooth, and Bluetooth Low Energy. Despite limited face-to-face interactions and time constraints, the assembly of all sensors and modules was accomplished, with the finished vehicle demonstrating admirable performance. | |
+ | This semester has been one of the most educational and fulfilling experiences for us, offering practical insights that we believe would impress industry leaders like Elon Musk. We express our gratitude to Preet, Tudor, and Kyle for their relentless efforts throughout the semester, and to our peers for partaking in this shared journey. Despite the prevailing difficult circumstances, we are confident about the future, anticipating the advent of a predominantly electric era. | ||
=== Project Video === | === Project Video === | ||
+ | [https://youtu.be/MTVcvbSQVEo Project Video] | ||
=== Project Source Code === | === Project Source Code === | ||
+ | <BR> | ||
+ | [https://gitlab.com/cmpe243_group_1_rc-car/sjtwo-c-cmpe-group-1-rc-car Git_Flow] | ||
+ | <BR> | ||
+ | |||
+ | === Advice for Future Students === | ||
+ | * Incorporate a mobile kill-switch mechanism to effectively halt the car's movement. This feature becomes particularly useful in situations where the car may exhibit unexpected behavior or operate at high speeds, providing the ability to remotely disable it wirelessly. | ||
+ | |||
+ | * Enhance the RC car's functionality by integrating a range of LED indicators. These indicators can serve multiple purposes, such as indicating GPS lock, app connection status, obstacle detection, and arrival at the destination. Including ample LED indicators enhances the user's understanding of the car's current state and actions. | ||
+ | |||
+ | * Modify the code to deactivate the on-board LEDs for each controller during the periodic_callbacks__initialize() phase. The existing code, which illuminates the LEDs in the peripherals_init() stage, can be adjusted to turn off the LEDs after initialization. This adjustment allows for the convenient use of LEDs as indicators, providing visual cues to detect unexpected board resets. | ||
+ | |||
+ | * Ensure the stability of compass readings by implementing appropriate measures. Calibration of the compass is crucial for accurate readings. Additionally, it is important to verify that tilting the car does not significantly impact the magnetometer readings. Mounting the compass module away from metal and any sources of hard or soft iron that could introduce inaccuracies helps in achieving reliable readings. | ||
+ | |||
+ | * Conduct unit testing on code modules to validate their expected behavior. Through rigorous testing, it becomes possible to ensure that each code module functions as intended, contributing to the overall success of the project. | ||
+ | |||
+ | * Perform outdoor testing in a suitable environment, such as a garage, once the car is capable of movement. This allows for a comprehensive assessment of its performance in real-world conditions. | ||
+ | |||
+ | * Take into account the limitations of ultrasonic sensors when testing in hallways, as they may provide inaccurate readings at steep angles. Furthermore, compass readings tend to be more precise when tested outside the building, where interference is reduced. Adjust the testing approach accordingly to account for these factors. | ||
+ | |||
+ | * Above all, maintain confidence in your abilities. Although the project may appear daunting, it has been carefully laid out by Preet, providing incremental milestones that gradually come together to create a complete and successful project. Trust in your skills and the structure of the project to overcome any challenges that may arise. | ||
− | |||
− | |||
=== Acknowledgement === | === Acknowledgement === | ||
+ | |||
+ | We would want to thank our instructor, Preet, for inspiring us to learn and solve challenging difficulties. We'd also want to thank him for sharing his professional knowledge and presenting us with a class and project that will help us and our future success in the business. | ||
+ | |||
=== References === | === References === | ||
+ | <BR> | ||
+ | 1. [https://www.adafruit.com/product/4019#technical-details Ultrasonic Sensor Documentation] | ||
+ | <BR> | ||
+ | <BR> | ||
+ | 2. [https://learn.adafruit.com/adafruit-ultimate-gps/downloads GPS Sensor Documentation] | ||
+ | <BR> | ||
+ | <BR> | ||
+ | 3. [https://www.robot-electronics.co.uk/files/cmps12.pdf CMPS12 Datasheet] | ||
+ | <BR> | ||
+ | <BR> | ||
+ | 4. [http://www.handsontec.com/dataspecs/I2C_2004_LCD.pdf LCD Datasheet] | ||
+ | <BR> | ||
+ | <BR> | ||
+ | 5. [https://controllerstech.com/lcd-20x4-using-i2c-with-stm32/ LCD Display Initialization and Configuration Example Tutorial] | ||
+ | <BR> | ||
+ | <BR> | ||
+ | 6. [https://morf.lv/simple-library-for-driving-20x4-lcd-with-4bits LCD Display Implementation and Flowchart Tutorial] | ||
+ | <BR> | ||
+ | |||
+ | |||
+ | <HR> | ||
+ | <BR/> | ||
+ | |||
+ | <HR> |
Latest revision as of 18:55, 27 May 2023
Contents
Project Title
X Æ A-13
Abstract
This report presents an overview of the technical progress made during the development of an autonomous RC car. The project involved comprehensive research, establishing a private git repository for version control, and procuring essential components such as CAN transceiver modules. Significant achievements included successful integration of ultrasonic sensors, compass module, and RPM sensor. The team successfully implemented obstacle avoidance algorithms, efficient GPS parsing, and precise PID control. Additionally, a mobile app was developed for real-time data visualization and control. Rigorous hardware testing and fine-tuning were conducted to ensure optimal performance. The report provides the technical advancements achieved in hardware-software integration and algorithm implementation for the successful development of the prototype.
Introduction
The project was divided into 5 modules:
- Sensor Node
- Motor Node
- Driver Node
- Geo Controller Node
- Android Application
Team Members & Responsibilities
The source code of our car can be found here: X Æ A-13 Gitlab Repository
Team Members |
Technical Roles | |||
---|---|---|---|---|
| ||||
| ||||
| ||||
| ||||
|
Schedule
Task# | Start Date | End Date | Task | Status | Point of Contact |
---|---|---|---|---|---|
1 | 02/13/2023 | 02/18/2023 |
|
Completed | Team |
2 | 02/19/2023 | 02/22/2023 |
|
Completed | Iftiza |
3 | 03/03/2023 | 03/10/2023 |
|
Completed | Sharan, Prabhat, Tushara |
4 | 03/11/2023 | 03/17/2023 |
|
Completed | Team |
5 | 03/18/2023 | 03/21/2023 |
Work on the RC Car Infrastructure Task
|
Completed |
|
6 | 03/22/2023 | 04/04/2023 |
Work on the Geo Controller Task
|
Completed |
|
7 | 04/05/2023 | 04/18/2023 |
Work towards the Prototype 1 Task
|
Completed |
|
8 | 04/19/2023 | 04/25/2023 | Work towards the Prototype 2 Task
|
Completed |
|
9 | 04/20/2023 | 05/02/2023 | Work towards the Prototype 3 Task
|
Completed |
|
10 | 05/03/2023 | 05/09/2023 | Work towards the Prototype 4 Task
|
Completed |
|
11 | 05/10/2023 | 05/24/2023 | Work towards the final demo
|
Completed |
|
12 | 05/10/2023 | 05/26/2023 | Project Wrap-up
|
Completed |
Team |
Parts List & Cost
Item# | Part Desciption | Vendor | Qty | Cost |
---|---|---|---|---|
1 | RC Car | Maverick Quantum MT [1] | 1 | $180.00 |
2 | RC Car Battery | Lithium Polymer Two-Cell | 1 | $20.0 |
3 | CAN Transceiver Modules | SN65HVD230 | 4 | $43.56 |
4 | SJTwo Microcontroller Development Board | SJSU | 5 | $250 |
5 | Ultrasonic Sensor | Adafruit US 100[2] | 4 | $48.69 |
6 | GPS Module | Adafruit PA1616S [3] | 1 | $32 |
7 | Compass Module | CMPS12 - RobotShop [4] | 1 | $39.77 |
8 | LCD Module | LCD1602 [5] | 2 | $12.02 |
Schematic
CAN Communication
Here is a brief description for all the messages and signals:
1. CHKPT_GPS_POSITION (ID: 101): Message transmitted by the GEOLOGICAL node, containing the following signals:
- **CHKPT_GPS_LATITUDE_SCALED**: The latitude of a checkpoint location, in degrees. - **CHKPT_GPS_LONGITUDE_SCALED**: The longitude of a checkpoint location, in degrees.
2. **CURRENT_GPS_POSITION (ID: 102)**: Message transmitted by the GEOLOGICAL node, containing:
- **CURRENT_GPS_LATITUDE_SCALED**: The current latitude of the vehicle, in degrees. - **CURRENT_GPS_LONGITUDE_SCALED**: The current longitude of the vehicle, in degrees.
3. **GEO_STATUS (ID: 103)**: Message transmitted by the GEOLOGICAL node, containing:
- **GEO_STATUS_COMPASS_ANGLE**: The current compass angle of the vehicle, in degrees. - **GEO_STATUS_BEARING_ANGLE_TO_DESTINATION**: The bearing angle from the vehicle to the destination, in degrees. - **GEO_STATUS_DISTANCE_TO_DESTINATION**: The distance from the vehicle to the destination, in meters. - **GEO_STATUS_BEARING_ANGLE_TO_CHKPT**: The bearing angle from the vehicle to the checkpoint, in degrees. - **GEO_STATUS_DISTANCE_TO_CHKPT**: The distance from the vehicle to the checkpoint, in meters.
4. **GEO_ANGLE_DELTA (ID: 104)**: Message transmitted by the GEOLOGICAL node, containing:
- **GEO_ANGLE_DIFF_TO_DEST**: The difference in angle between the vehicle's current direction and the direction to the destination, in degrees. - **GEO_ANGLE_DIFF_TO_CHKPT**: The difference in angle between the vehicle's current direction and the direction to the checkpoint, in degrees.
5. **GEO_LOCK (ID: 105)**: Message transmitted by the GEOLOGICAL node, containing:
- **GEO_LOCK_TO_DESTINATION**: A boolean signal indicating whether the vehicle is locked onto the destination.
6. **SENSOR_SONARS (ID: 201)**: Message transmitted by the SENSOR node, containing:
- **SENSOR_SONARS_left/right/middle/rear**: The readings from sonar sensors located at left, right, middle, and rear positions, in centimeters.
7. **DEST_GPS_POSITION (ID: 202)**: Message transmitted by the SENSOR node, containing:
- **DEST_GPS_LATITUDE_SCALED**: The latitude of the destination, in degrees. - **DEST_GPS_LONGITUDE_SCALED**: The longitude of the destination, in degrees.
8. **CAR_HEARTBEAT (ID: 203)**: Message transmitted by the SENSOR node, containing:
- **HEARTBEAT_DATA**: A boolean heartbeat signal indicating the operational status of the car.
9. **MOTOR_CMD (ID: 302)**: Message transmitted by the DRIVER node, containing:
- **MOTOR_CMD_steer**: The command to the steering mechanism. - **MOTOR_CMD_drive**: The command to the driving mechanism.
10. **LCD_DATA_FROM_MOTOR_NODE (ID: 401)**: Message transmitted by the MOTOR node, containing:
- **RPM_SENSOR_SPEED**: The speed of the vehicle as measured by an RPM sensor, in kilometers per hour. - **SERVO_PWM**: The PWM (Pulse Width Modulation) signal for the servo, as a percentage of maximum. - **MOTOR_PWM**: The PWM signal for the motor, as a percentage of maximum.
11. **DEBUG_CHK (ID: 901)**: Message transmitted by the GEOLOGICAL node, containing debug information:
- **GPS_PASS_COUNTER**: The count of successful GPS operations. - **GPS_FAIL_COUNTER**: The count of failed GPS operations. - **CMPS_PASS_COUNTER**: The count of successful compass operations. - **CMPS_FAIL_COUNTER**: The count of failed compass operations.
Each message and signal listed above contains additional data points like bit size, start position, byte order, value type, scaling factor, offset, minimum, maximum, and unit. These data points determine how to interpret the raw signal values from the CAN bus.
Hardware Design
DBC File
Gitlab link to the X Æ A-13 DBC file
VERSION "2.5" NS_ : BA_ BA_DEF_ BA_DEF_DEF_ BA_DEF_DEF_REL_ BA_DEF_REL_ BA_DEF_SGTYPE_ BA_REL_ BA_SGTYPE_ BO_TX_BU_ BU_BO_REL_ BU_EV_REL_ BU_SG_REL_ CAT_ CAT_DEF_ CM_ ENVVAR_DATA_ EV_DATA_ FILTER NS_DESC_ SGTYPE_ SGTYPE_VAL_ SG_MUL_VAL_ SIGTYPE_VALTYPE_ SIG_GROUP_ SIG_TYPE_REF_ SIG_VALTYPE_ VAL_ VAL_TABLE_ BS_: BU_: GEOLOGICAL SENSOR DRIVER MOTOR BO_ 101 CHKPT_GPS_POSITION: 8 GEOLOGICAL SG_ CHKPT_GPS_LATITUDE_SCALED : 0|32@1- (1,0) [-90000000|90000000] "degree" DRIVER SG_ CHKPT_GPS_LONGITUDE_SCALED : 32|32@1- (1,0) [-180000000|180000000] "degree" DRIVER BO_ 102 CURRENT_GPS_POSITION: 8 GEOLOGICAL SG_ CURRENT_GPS_LATITUDE_SCALED : 0|32@1- (1,0) [-90000000|90000000] "degree" DRIVER SG_ CURRENT_GPS_LONGITUDE_SCALED : 32|32@1- (1,0) [-180000000|180000000] "degree" DRIVER BO_ 103 GEO_STATUS: 8 GEOLOGICAL SG_ GEO_STATUS_COMPASS_ANGLE : 0|10@1+ (1,0) [0|359] "degree" DRIVER SG_ GEO_STATUS_BEARING_ANGLE_TO_DESTINATION : 10|10@1+ (1,0) [0|359] "degree" DRIVER SG_ GEO_STATUS_DISTANCE_TO_DESTINATION : 20|16@1+ (1,0) [0|2000] "meter" DRIVER SG_ GEO_STATUS_BEARING_ANGLE_TO_CHKPT : 36|10@1+ (1,0) [0|359] "degree" DRIVER SG_ GEO_STATUS_DISTANCE_TO_CHKPT : 46|16@1+ (1,0) [0|2000] "metre" DRIVER BO_ 104 GEO_ANGLE_DELTA: 4 GEOLOGICAL SG_ GEO_ANGLE_DIFF_TO_DEST : 0|16@1- (1,0) [-359|359] "degree" DRIVER SG_ GEO_ANGLE_DIFF_TO_CHKPT : 16|16@1- (1,0) [-359|359] "degree" DRIVER BO_ 105 GEO_LOCK: 1 GEOLOGICAL SG_ GEO_LOCK_TO_DESTINATION : 0|8@1+ (1,0) [0|1] "boolean" DRIVER BO_ 201 SENSOR_SONARS: 5 SENSOR SG_ SENSOR_SONARS_left : 0|10@1+ (1,0) [0|1000] "cm" DRIVER SG_ SENSOR_SONARS_right : 10|10@1+ (1,0) [0|1000] "cm" DRIVER SG_ SENSOR_SONARS_middle : 20|10@1+ (1,0) [0|1000] "cm" DRIVER SG_ SENSOR_SONARS_rear : 30|10@1+ (1,0) [0|1000] "cm" DRIVER BO_ 202 DEST_GPS_POSITION: 8 SENSOR SG_ DEST_GPS_LATITUDE_SCALED : 0|32@1- (1,0) [-90000000|90000000] "degree" GEOLOGICAL,DRIVER SG_ DEST_GPS_LONGITUDE_SCALED : 32|32@1- (1,0) [-180000000|180000000] "degree" GEOLOGICAL,DRIVER BO_ 203 CAR_HEARTBEAT: 1 SENSOR SG_ HEARTBEAT_DATA : 0|8@1+ (1,0) [0|1] "boolean" DRIVER BO_ 302 MOTOR_CMD: 3 DRIVER SG_ MOTOR_CMD_steer: 0|8@1- (1,-5) [-5|5] "" MOTOR SG_ MOTOR_CMD_drive : 8|16@1- (1,-9) [-9|9] "kph" MOTOR BO_ 401 LCD_DATA_FROM_MOTOR_NODE: 3 MOTOR SG_ RPM_SENSOR_SPEED: 0|6@1+ (1,0) [0|50] "kph" DRIVER SG_ SERVO_PWM: 6|7@1+ (1,0) [0|100] "percent" DRIVER SG_ MOTOR_PWM: 13|7@1+ (1,0) [0|100] "percent" DRIVER BO_ 901 DEBUG_CHK: 8 GEOLOGICAL SG_ GPS_PASS_COUNTER: 0|16@1+ (1,0) [0|64000] "count" DRIVER SG_ GPS_FAIL_COUNTER: 16|16@1+ (1,0) [0|64000] "count" DRIVER SG_ CMPS_PASS_COUNTER: 32|16@1+ (1,0) [0|64000] "count" DRIVER SG_ CMPS_FAIL_COUNTER: 48|16@1+ (1,0) [0|64000] "count" DRIVER CM_ BU_ DRIVER "The driver node of the car"; CM_ BU_ MOTOR "The motor controller node of the car"; CM_ BU_ SENSOR "The sensor controller node of the car"; CM_ BU_ GEOLOGICAL "The geoposition and geodirection controller of the car"; CM_ BO_ 101 "Sync message used to synchronize the controllers from driver node"; CM_ BO_ 102 "Sync message used to synchronize the controllers from sensor node"; CM_ SG_ 101 DRIVER_HEARTBEAT_cmd "Heartbeat command from the driver";
Sensor ECU
Hardware Design
Adafruit US-100 Ultrasonic Range Finder
- Detection Range(reliable): 2 cm to 250 cm.
- 3-5V operation range.
- UART Output, PWM output.
- Accuracy: 3mm
- Measuring angle covered: <15°
- Operating Current: <15mA
- Operating Frequency: 40Hz
HC-05 Bluetooth Module
- Bluetooth version: 2.0 + EDR (Enhanced Data Rate)
- Frequency: 2.4 GHz ISM band
- Modulation: GFSK (Gaussian Frequency Shift Keying)
- Transmit power: Class 2 (up to 4 dBm)
- Sensitivity: -80 dBm typical
- Range: approximately 10 meters (or 33 feet) in open air
- Profiles supported: SPP (Serial Port Profile), HID (Human Interface Device) and others
- Operating voltage: 3.3V to 5V DC
- Operating current: less than 50mA
- Standby current: less than 2.5mA
- Sleep current: less than 1mA
- Interface: UART (Universal Asynchronous Receiver/Transmitter)
- Baud rates: 1200, 2400, 4800, 9600, 19200, 38400, 57600, 115200, 230400, and 460800
- Operating temperature: -20°C to 75°C (-4°F to 167°F)
We employed a set of four Adafruit US-100 Ultrasonic Range Finders as sensory components in our project. These ultrasonic sensors were integrated into the RC car system with the objective of enabling effective obstacle avoidance. To achieve this, we strategically positioned three sensors on the front side of the RC car, while the remaining sensor was placed at the rear.
The sensors were powered by a +5V supply voltage. An indicative sign of successful data retrieval was the toggling of LED3 on the SJ2 board.
The operational principle is as follows: When the trigger pin is set to a HIGH state for a minimum duration of 10 microseconds, the module automatically emits a 40 kHz ultrasonic wave from the Ultrasonic transmitter. This wave propagates through the air and, upon encountering an obstruction, it reflects back towards the sensor. The Ultrasonic receiver module detects this reflected wave. As soon as the wave returns, the Echo pin becomes HIGH for a specific duration, equivalent to the time it took for the wave to travel back to the sensor.
for UART: To establish communication with the sensor, a UART baud rate of 9600 is utilized. In UART mode, a command is sent by transmitting the hexadecimal value 0x55 to the sensor. Following the command transmission, two bytes (a 16-bit value) are read back, representing the distance in millimeters (mm).
The SJ2 board measures the length of time during which the Echo pin remains HIGH, providing information about the duration of the wave's round trip. Utilizing this information, the distance is calculated, as described in the previous section. The formula used to measure the distance to the object is Distance = Speed × Time, where the speed represents the speed of sound.
Software Design
Among these sensors, two employed UART communication to transmit distance data to the SJ2 microcontroller, whereas the other two utilized interrupt-based communication. To facilitate communication with the SJ2 microcontroller, UART1 and UART3 were designated for the right and left sensors, respectively. Additionally, pins P0.6 and P0.7 were allocated as trigger pins, while pins P2.0 and P2.1 served as echo pins for the front and rear sensors. UART2 is being used for communication with HC-05 module.
Sensors were divided into two groups:
- Front and Rear
- Left and Right
Each group utilizes a frequency of 10Hz. The provided code demonstrates its periodic invocation.
void periodic_callbacks__10Hz(uint32_t callback_count) {
get_sonar_values();
if ((ultrasonic_can_tx()) && (car_heartbeat_tx_10hz()) && (destination_coordinate_tx_10hz())) {
gpio__toggle(board_io__get_led3());
}
</syntaxhighlight lang="cpp">
The following code snippet demonstrates the initialization of the triggers for the front and rear sensors in 100Hz.
<syntaxhighlight lang="cpp">
void periodic_callbacks__100Hz(uint32_t callback_count) {
ultrasonic_implementation__initiate_ultrasonics_range();
}
The following code snippet demonstrates the communication with the bluetooth/app:
void periodic_callbacks__1Hz(uint32_t callback_count) {
bool return_val = false;
return_val = get_app_data_1hz();
if (return_val) {
gpio__toggle(board_io__get_led2());
}
}
Technical Challenges
- Issue: The presence of noise in the sensor measurements is causing instability in the car's steering, resulting in a wobbly motion.
- Solution: To address the issue of noise in the sensor measurements and stabilize the car's steering, we have implemented an average buffer. This buffer calculates the average value based on the last 10 readings rather than relying on a single value. By taking into account multiple readings over a period of time, the average buffer helps to reduce the impact of noise and provide a more stable steering response for the car.
Motor ECU
<Picture and link to Gitlab>
The primary function of this module involves establishing a communication interface with the Driver Node, employing the CAN (Controller Area Network) communication protocol. Through this communication protocol, the module receives and retrieves the desired speed and steering angle information from the Driver Node. The CAN protocol facilitates the exchange of data between the module and the Driver Node, enabling seamless transmission of control signals for speed and steering angle adjustments.
Motors work on the PWM (pulse width modulation) values which are given by the ESC. ESCs process input signals, convert them into digital values, use algorithms to determine motor speed, generate PWM signals with variable pulse width, calculate duty cycle, and drive motors through power transistors to control speed. Understanding these PWM values for motor movements is a critical task which has to be done when we start working on the project.
Hardware Design
Schematics
The SJTwo board provided us with the necessary PWM pins, specifically P2.1 and P2.0, to which we connected the servo and DC motor, respectively. These pins were selected based on their capability to generate PWM signals required for precise control of the motors.
The SJTwo board is equipped with a powerful microcontroller, offering ample processing power and I/O capabilities. With its PWM functionality, we were able to modulate the output signals to control the servo and DC motor with high precision.
RPM Sensor
In our project, we have incorporated a Hall effect RPM sensor for monitoring the rotational speed of the vehicle's wheels. The RPM sensor is strategically positioned on the car's chassis, adjacent to the shock absorbers. This placement ensures accurate measurement of the wheel's rotational speed. The RPM sensor serves as a vital input for maintaining a consistent speed of the vehicle.
The RPM data obtained from the sensor is utilized by a PID (Proportional-Integral-Derivative) controller to regulate and fine-tune the vehicle's speed. By continuously monitoring the RPM, the PID controller makes necessary adjustments to ensure the vehicle maintains the desired speed. The RPM sensor acts as a critical source of speed information, enabling the PID controller to effectively and dynamically govern the vehicle's speed to achieve the desired stability and control.
Hacking the RF Module
In order to make the RC car autonomous, we faced the challenge of eliminating the need for the remote control typically used to operate the car. Our specific model, the Maverick Quantum MT, did not have its PWM (Pulse Width Modulation) sequence readily available in open-source form. Therefore, we had to delve into the process of detecting the PWM signals transmitted by the RC receiver to the Electronic Speed Controller (ESC) module.
To accomplish this, we employed an oscilloscope or a logic analyzer. However, we found that the logic analyzer was particularly advantageous due to its user-friendly interface and software capabilities for analyzing the obtained signals. By connecting the logic analyzer to the RC car's receiver, we were able to capture and analyze the PWM signals in detail.
Through the analysis, we were able to identify important parameters of the PWM signals, such as the duty cycle and frequency. These parameters corresponded to various actions performed by the servo and motor in the RC car. By understanding the relationship between these parameters and the desired actions, we gained the ability to replicate and control these actions autonomously, effectively replacing the functionality of the remote control.
This process of detecting and interpreting the PWM signals was essential for enabling autonomous control of the RC car. It allowed us to develop a custom control system that could replicate the desired actions based on the analyzed PWM signals. With this system in place, the RC car became capable of executing predefined maneuvers and tasks without relying on manual input from a remote control.
Overall, the utilization of an oscilloscope or logic analyzer, along with the analysis of PWM signals, played a crucial role in our endeavor to make the RC car autonomous. By gaining insights into the PWM parameters and implementing a custom control system, we were able to take control of the car's functions and pave the way for autonomous operation.
Here are the data we obtained
Control Unit | Direction | Frequency (Hz) | Duty Cycle (%) |
---|---|---|---|
Servo Motor | Right Max | 61.02 | 5.9 |
Left Max | 61.02 | 12.62 | |
Motor | Forward Max Speed | 61.02 | 12.65 |
Idling (Zero) Speed | 61.02 | 9.27 | |
Reverse Max Speed | 61.02 | 5.66 |
The duty cycle for crawling the car at the slowest speed = 9.47%.
Software Design
The motor node code has been meticulously structured into multiple modules, showcasing a robust implementation of modularization principles. This approach enhances code organization, readability, and maintainability. The core section of the code encompasses the motor driver logic, precisely defining the motor's response in the presence of obstacles or impediments. By encapsulating this functionality, the code remains focused and comprehensible, facilitating future updates and modifications.
The codebase has been segregated into distinct files, each serving a specific purpose. One such file handles the RPM-related operations, enabling precise control and monitoring of the motor's rotational speed. Another file is dedicated to the implementation of the proportional-integral-derivative (PID) control, governing the motor's behavior based on feedback and error correction. This separation of concerns ensures modularity, allowing developers to modify or enhance specific aspects without disrupting the overall functionality.
A separate code base is devoted to the initialization process, streamlining the configuration of GPIO (General Purpose Input/Output) and PWM (Pulse Width Modulation) channels associated with the motor. This modularized initialization file provides a clear overview of the motor-related setup, making it easier to manage and maintain.
Periodic Callback Functions
Periodic Callback: Init
- The CAN bus is initialized
- The RPM sensor interrupts are initialized.
- The Motor and servo PWM signals are initialized and set to default values.
Periodic Callback: 1Hz
- The motors start-up sequence is designed.
Periodic Callback: 10Hz
- Decode the driving speed and steering sent by the Driver node after reading all CAN messages.
Motors Startup sequence
void run_once_motor_startup_sequence(uint32_t callback_count, bool *test_flag){ static float test_duty_cycle = 9.84; static bool run_once = true; if (run_once) { if ((callback_count > 1) && (test_duty_cycle <= 10)) { pwm1__set_duty_cycle(PWM1__2_0, test_duty_cycle); test_duty_cycle += 0.3f; if (test_duty_cycle >= 10) { *test_flag = true; run_once = false; } } } }
The run_once_motor_startup_sequence function is designed to perform an initial motor startup sequence. It takes two parameters: callback_count, which represents the number of callbacks, and test_flag, a boolean pointer.
Within the function, a duty cycle value is gradually incremented until it reaches 10. During each iteration, the duty cycle is set using the pwm1__set_duty_cycle function. Once the duty cycle reaches 10, the test_flag is set to true, indicating that the motor startup sequence is complete. This flag can then be used as a trigger to start reading CAN messages or perform other actions in the code.
Code Flow
When motor_cmd->MOTOR_CMD_drive is 1: The motor gradually accelerates to a target speed of 8.5 kph using the compute_and_set_motor_pwm function. The speed is controlled by adjusting the PWM duty cycle, specifically using the motor_fwd_slow_speed_pwm value.
When motor_cmd->MOTOR_CMD_drive is 0: The motor enters a hard stop braking state, indicated by setting the PWM duty cycle to motor_hard_stop_braking.
When motor_cmd->MOTOR_CMD_drive is -1: The motor enters reverse mode, with the PWM duty cycle set to motor_reverse_speed.
When motor_cmd->MOTOR_CMD_drive is 7: The motor is set to a neutral position, maintaining a constant speed using the motor_neutral_pwm value.
When motor_cmd->MOTOR_CMD_steer is -1: The motor is steered slightly to the left using the turn_slight_left PWM duty cycle.
When motor_cmd->MOTOR_CMD_steer is -2: The motor is turned fully to the left using the turn_full_left PWM duty cycle.
When motor_cmd->MOTOR_CMD_steer is 2: The motor is turned fully to the right using the turn_full_right PWM duty cycle.
When motor_cmd->MOTOR_CMD_steer is 1: The motor is steered slightly to the right using the turn_slight_right PWM duty cycle.
These control actions enable precise control of the motor's speed and steering, allowing it to respond to different drive and steer commands. The PWM duty cycles determine the motor's behavior, ensuring smooth acceleration, deceleration, and controlled steering angles based on the input commands.
Why did we choose to follow this above approach ?
Modularity and Readability: The code is organized into separate functions, each handling specific motor control tasks. This modular structure enhances code readability, making it easier to understand and maintain. By isolating different functionalities, it promotes code reusability and scalability.
Flexibility and Extensibility: The code incorporates well-defined variables and constants, such as motor_fwd_slow_speed_pwm, motor_hard_stop_braking, and turn_slight_left. By using these parameters, it becomes effortless to fine-tune the motor's behavior without modifying the core logic. This flexibility enables easy adjustment of speed, braking, and steering parameters based on specific requirements.
Controlled Acceleration and Braking: The code implements gradual acceleration and deceleration techniques through the go_to_neutral_gradually and go_to_reverse_gradually functions. This controlled approach ensures smooth transitions between different speed states, enhancing safety and stability during motor operations.
Real-time Feedback: The code utilizes variables like current_kph and target_kph to monitor the motor's speed and provide real-time feedback. By continuously assessing the current speed and adjusting the PWM duty cycle accordingly, the code can dynamically regulate the motor's behavior to maintain the desired target speed.
Consistent and Predictable Steering: By associating specific PWM duty cycles with various steering commands, such as turn_slight_left and turn_full_right, the code ensures consistent and predictable steering behavior. This allows for accurate maneuvering and navigation control of the motor.
PID Implementation
double pid_controller_compute_value(double setpoint, double input_speed) { double error = setpoint - input_speed; double proportional = Kp * error; integral += Ki * error * dt; double derivative = Kd * (error - last_error) / dt; double output = proportional + integral + derivative; last_error = error; return output; }
The function pid_controller_compute_value takes in the setpoint (the desired target value) and the input speed as parameters. It calculates the error by subtracting the input speed from the setpoint. The proportional term (proportional) is computed by multiplying the error by the proportional gain (Kp), representing the immediate response to the error. The integral term accumulates the error over time, as the error is multiplied by the integral gain (Ki) and the time increment (dt), and added to the integral variable. The derivative term (derivative) considers the rate of change of the error, calculated by multiplying the difference between the current and last errors by the derivative gain (Kd), and dividing by the time increment (dt).
The output of the PID controller is obtained by summing the proportional, integral, and derivative terms. The last error is stored for reference in the next iteration. The resulting output is returned by the function.
This implementation allows the PID controller to dynamically adjust the control output based on the error and its rate of change, enabling effective control and regulation of the system
Technical Challenges
1. Understanding the startup sequence
The electronic speed controller (ESC) incorporates a specific startup sequence that must be followed in order to initiate and activate the motors. Failure to replicate this sequence accurately will result in the inability to start the motors. Determining this startup sequence requires a significant investment of time and effort. To understand and replicate the sequence, we continuously analyze the PWM (pulse width modulation) values transmitted by the remote control. By carefully studying the data and observing the pattern of PWM values, we can develop a code that mimics the exact sequence in our own programming. During this process, a logic analyzer proves to be immensely valuable. It assists us in navigating through the complexities of the startup sequence, providing insights and facilitating the accurate replication of the required PWM values in our code. The logic analyzer enables us to effectively analyze and interpret the timing and patterns of the PWM signals, aiding in the successful implementation of the ESC's startup sequence.
2. Making the reverse work properly
To ensure proper reverse operation, we implemented a synchronization mechanism between the rear sensor data and control commands. By aligning and correlating these inputs, we achieved controlled and seamless transitions between forward and reverse motion. This synchronization played a crucial role in preventing unintended movements and facilitating effective maneuvering around obstacles. The careful coordination of rear sensor data and control commands enabled us to maintain control and achieve reliable reverse operation while ensuring a smooth transition back to normal forward motion.
Geographical Controller
In today's technologically advanced world, navigation has become an indispensable part of peoples lives. Whether exploring unfamiliar territories or simply trying to find way through a bustling city, reliable and accurate navigation systems have become paramount. Among the various advancements in this field, one remarkable innovation is the development of Automatic GEO navigation, which combines the power of GPS (Global Positioning System) and compass sensor technology. This groundbreaking fusion enables users to effortlessly navigate their surroundings, ensuring precise location tracking and directional guidance.
For this feature development in the project two standard GPS and COMPASS sensor were selected after a thorough market research. The following sensors are more reliable and easier from the perspective of data extraction.
GPS module
Adafruit Ultimate GPS Breakout Board; interacts in UART 9600 BAUD_RATE
COMPASS module
Tilt Compensated Magnetic COMPASS (CMPS12) from BOSCH; interacts in I2C
GEO_NODE_Sketch with MS_VISIO
Pin Diagram for the GEO Node with SJ2 Board and CAN_bus
Hardware Design
Both the GPS sensor and the COMPASS sensor has to be powered from a specific required voltage level and they require specific amount of current to response accurately. For that a reliable design is a must. First of all the board interaction pin were decided based on the communication bus required to interact with these sensors. According to that a rough sketch was made to have a reference. Then finally with all the sensors, SJ2 board and for ECU communication CAN transceiver's connection were generated in a Schematic design tool for future reliable hardware design (noise free). Sensor signals are very sensitive to noise levels.
Schematic Design (GEO_NODE)
Hardware architecture for GEO_NODE with SJ2 Board and CAN_bus
Software Design
GEO_NODE code modules have organized sections for better user readability. It has the following code modules low level to high level:
myQeue, line_buffer, gps, compass, coordinate_calculation, waypoints, can_initialize, can_tx, can_rx
To have a understanding on the total GEO NODE development; these module plays a great deal. GPS module gives bunch of sets of serial line from where we need to extract a special line for our coordinate. For that we need a good buffer. That's why a circular queue based buffer was used via line_buffer & myQueue modules. These were pre designed in the course lab sessions and here it is re-touched for GPS parsing with good unit tests.
GPS Extraction
GPS module gives couple of NMEA data in 1Hz rate. We are storing those lines in line buffer and from that line buffer we extract only the required line that we are looking for. And when we have the line we call the gps_parsing API to get that coordinate and store in GPS_coordinate structure to store it. a sniff of the GPS parsign is given below:
static bool gps__parse_coordinates_from_line(gps_coordinates_t *parsed_coordinates) {
bool return_val = false;
char gps_NMEA_read_line[512];
char parse_string[16]; // Size 16 has no significant. This string is used as a temporary place to store parsed
// characters
char helper_string[4];
uint8_t index = 0u;
memset(gps_NMEA_read_line, 0u, sizeof(gps_NMEA_read_line));
while (line_buffer__remove_line(&line_buffer, gps_NMEA_read_line, sizeof(gps_NMEA_read_line))) {
index = 0u;
memset(parse_string, 0u, sizeof(parse_string));
if (NEMA_DATA_TYPE_SIZE ==
gps_parse_string(&gps_NMEA_read_line[index], parse_string)) // GPS parsing for NMEA data type
{
if ((parse_string[0] == '$') && (parse_string[1] == 'G') && (parse_string[2] == 'P') &&
(parse_string[3] == 'G') && (parse_string[4] == 'G') && (parse_string[5] == 'A')) {
uint8_t size;
index = index + NEMA_DATA_TYPE_SIZE + 1u;
memset(parse_string, 0u, sizeof(parse_string));
size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for Time (Dummy as not needed)
index = index + size + 1u;
memset(parse_string, 0u, sizeof(parse_string));
size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for Lattitude
index = index + size + 1u;
if (size == LATTITUDE_SIZE) {
helper_string[0] = parse_string[0];
helper_string[1] = parse_string[1];
helper_string[2] = 0;
// Convert Lattitude from string to float
parsed_coordinates->latitude =
atof(helper_string) + (atof(&parse_string[2]) / 60.0); // Convert DD. // Convert MM
memset(parse_string, 0u, sizeof(parse_string));
size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for lattitude sign
index = index + size + 1u;
if (size == 1u) {
if (parse_string[0] == 'S') {
parsed_coordinates->latitude = -parsed_coordinates->latitude;
}
memset(parse_string, 0u, sizeof(parse_string));
size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for Longitude
index = index + size + 1u;
if (size == LONGITUDE_SIZE) {
helper_string[0] = parse_string[0];
helper_string[1] = parse_string[1];
helper_string[2] = parse_string[2];
helper_string[3] = 0;
// Convert Longitude from string to float
parsed_coordinates->longitude =
atof(helper_string) + (atof(&parse_string[3]) / 60.0); // Convert DD. // Convert MM
memset(parse_string, 0u, sizeof(parse_string));
size = gps_parse_string(&gps_NMEA_read_line[index], parse_string); // GPS parsing for longitude sign
index = index + size + 1u;
if (size == 1u) {
if (parse_string[0] == 'W') {
parsed_coordinates->longitude = -parsed_coordinates->longitude;
}
return_val = true;
}
}
}
}
}
}
}
return return_val;
}
A GPGGA message appears as follows (our target NMEA line from sensor):
Message Format: $GPGGA,HHMMSS.SS,DDMM.MMMMM,K,DDDMM.MMMMM,L,N,QQ,PP.P,AAAA.AA,M,±XX.XX,M, SSS,RRRR*CC<CR><LF>
Message Component | Description |
---|---|
$GPGGA | Message type indicator |
HHMMSS.SS | UTC time in hours, minutes, and seconds of the position |
DDMM.MMMMM | Latitude in degrees, minutes, and decimal minutes |
K | Latitude indicator; value is N (North latitude) or S (South latitude) |
DDDMM.MMMMM | Longitude in degrees, minutes, and decimal minutes |
L | Longitude indicator; value is E (East longitude) or W (West longitude) |
N | Quality indicator (indicates positional lock) |
Number of satellites used in position solution | |
PP | Horizontal dilution of precision (HDOP) |
A.A | Antenna altitude, in meters, re: mean-sea-level (geoid) |
M | Units of antenna altitude (M = meters) |
G.G | Geoidal separation (in meters) |
M | Units of geoidal separation (M = meters) |
SSS | Age of differential corrections, in seconds |
RRRR | Differential reference station ID |
*CC | Checksum |
<CR> | Checksum |
<LF> | Carriage return |
COMPASS Extraction
COMPASS sensor data extraction were way more simpler than GPS sensor. It interacted with the SJ2 board in I2C. Also it didn't need any calibration sequence as the CMPS12 itself calibrates the data and sends.
bool compass__read_heading(void) {
const uint8_t COMPASS_HEADING_BYTES = 2;
uint8_t received_raw_data[2] = {0};
bool i2c_read_status = false;
i2c_read_status = i2c__read_slave_data(compass_i2c, CMPS12_SLAVE_ADDRESS_DEFAULT, CMPS12_RAW_BEARING_HIGH_BYTE_BOSCH,
received_raw_data, COMPASS_HEADING_BYTES);
if (i2c_read_status) {
compass_heading_degrees = ((float)(((uint16_t)received_raw_data[0] << 8) | ((uint16_t)received_raw_data[1]))) /
CMPS12_BOSCH_HEADING_SCALING_FACTOR;
}
return i2c_read_status;
}
float compass__get_heading_degrees(void) { return compass_heading_degrees; }
Calculations for distances and bearing angle
For geo_algorithm we need to calculate the bearing angle from point A to point B to compare with the car's COMPASS also distance needs to be calculated. For this, IgIS map tool algorithm were used. These algorithm were verified from MATLAB and tested with reference coordinates and then finally implemented on SJ2 board. Below is the code sniff:
float coordinate_calculation__distance_meter(float latitude_current, float longitude_current,
float latitude_destination, float longitude_destination) {
if (abs(latitude_destination - (float)0.0) < (float)0.00000000001 &&
abs(longitude_destination - (float)0.0) < (float)0.00000000001) {
return 0;
}
/*
Law of Haversine to calculate distance between two co-ordinate
Reference from iGisMAP tool
*/
float latitude_current_radian = (PI / ((float)180.0)) * latitude_current;
float longitude_current_radian = (PI / ((float)180.0)) * longitude_current;
float latitude_destination_radian = (PI / ((float)180.0)) * latitude_destination;
float longitude_destination_radian = (PI / ((float)180.0)) * longitude_destination;
float delta_laitude_radian = latitude_destination_radian - latitude_current_radian;
float delta_longitude_radian = longitude_destination_radian - longitude_current_radian;
float a = (sin(delta_laitude_radian / ((float)2.0)) * sin(delta_laitude_radian / ((float)2.0))) +
(cos(latitude_current_radian) * cos(latitude_destination_radian) *
sin(delta_longitude_radian / ((float)2.0)) * sin(delta_longitude_radian / ((float)2.0)));
float c = ((float)2.0) * ((float)atan2(sqrt(a), sqrt(1 - a)));
float distance_in_km = EARTH_RADIUS_IN_KM * c;
float distance_in_m = distance_in_km * ((float)1000.0);
return distance_in_m;
}
float coordinate_calculation__bearing_degree(float latitude_current, float longitude_current,
float latitude_destination, float longitude_destination) {
if (abs(latitude_destination - (float)0.0) < (float)0.00000000001 &&
abs(longitude_destination - (float)0.0) < (float)0.00000000001) {
return 0;
}
/*
No bearing can happen without NORTH reference
Angle measured in clock-wise rotation
Reference from iGisMAP tool
*/
float latitude_current_radian = (PI / (float)180.0) * latitude_current;
float longitude_current_radian = (PI / (float)180.0) * longitude_current;
float latitude_destination_radian = (PI / (float)180.0) * latitude_destination;
float longitude_destination_radian = (PI / (float)180.0) * longitude_destination;
float delta_laitude_radian = latitude_destination_radian - latitude_current_radian;
float delta_longitude_radian = longitude_destination_radian - longitude_current_radian;
float x_radian = cos(latitude_destination_radian) * sin(delta_longitude_radian);
float y_radian = (cos(latitude_current_radian) * sin(latitude_destination_radian)) -
(sin(latitude_current_radian) * cos(latitude_destination_radian) * cos(delta_longitude_radian));
float bearing_rad = atan2(x_radian, y_radian);
float bearing_deg = bearing_rad * ((float)180.0 / PI);
float bearing_deg_scaled_360 = (float)0.0;
if (bearing_deg < (float)0.0) {
bearing_deg_scaled_360 = ((float)360.0) + bearing_deg;
} else {
bearing_deg_scaled_360 = bearing_deg;
}
return bearing_deg_scaled_360;
}
bool coordinate_calculation__arrived(float latitude_current, float longitude_current, float latitude_destination,
float longitude_destination) {
float margin_of_error = 0.01; /* 10cm error margin to reach destination */
float distance = coordinate_calculation__distance_meter(latitude_current, longitude_current, latitude_destination,
longitude_destination);
if (distance < margin_of_error) {
return true;
} else {
return false;
}
}
Waypoint Algorithm
For waypoint algorithm a simple approach were used. We set some intermediary waypoint coordinates to go from point A to point B. We sniffed those intermediary points and followed towards destination. The destination was received from the BRIDGE controller. Bridge controller receives the coordinate from mobile app and sends to can_bus. GEO_NODE sniff that destination coordinate and stores to waypoint module to enable the path routing.
gps_coordinates_t find_closest_waypoint_coordinate(gps_coordinates_t current_coordinate,
gps_coordinates_t destination_coordinate) {
waypoints[4] = destination_coordinate;
float current_to_waypoint_distance =
coordinate_calculation__distance_meter(current_coordinate.latitude, current_coordinate.longitude,
waypoints[waypoint_index].latitude,
waypoints[waypoint_index].longitude);
if (current_to_waypoint_distance < 4.0f && (waypoint_index <= 3)) {
waypoint_index++;
}
return destination_coordinate;
}
Periodic callback Flow
First all the modules are initialized and then the GPS and COMPASS modules care called for sensor extraction from a lower callback task and stored in a secured set points. Then for the can communication a comparative higher task were used to throw those angle and distance parameters to driver node for automatic hovering.
void periodic_callbacks__initialize(void) {
// This method is invoked once when the periodic tasks are created
const uint32_t can_baud_rate_kbps = 100U;
const uint16_t can_rx_q = 100U;
const uint16_t can_tx_q = 100U;
const can__num_e can_name = can1;
compass__initialize(); // Pin--> P0.10(I2C-2 SDA2), P0.11(I2C-2 SCL2)
gps__init(); // Pin--> P0.15(Uart-1 Tx), P0.16(Uart-1 Rx)
can_initialization(can_name, can_baud_rate_kbps, can_rx_q, can_tx_q);
if_can_bus_off__restart_can_bus(can_name);
destination_coordinate_rx();
}
void periodic_callbacks__1Hz(uint32_t callback_count) {
bool return_val = false;
return_val = get_gps_sensor_1hz();
if (return_val == true) {
gpio__toggle(board_io__get_led0());
debug_gps_counter_pass++;
} else {
debug_gps_counter_fail++;
}
if (gps_lock_chk == true) {
gpio__reset(board_io__get_led3());
} else {
gpio__set(board_io__get_led3());
}
}
void periodic_callbacks__10Hz(uint32_t callback_count) {
bool return_val = false;
bool return_val1 = false;
return_val = get_compass_sensor_10hz();
if (return_val == true) {
gpio__toggle(board_io__get_led1());
debug_CMPS_counter_pass++;
} else {
debug_CMPS_counter_fail++;
}
return_val1 = destination_coordinate_rx();
if (return_val1) {
chk_rcvd_gps_app = get_destination_coordinates();
}
if ((chk_rcvd_gps_app.latitude > 0.0f) || (chk_rcvd_gps_app.latitude < 0.0f)) {
gps_lock_chk = true;
} else {
gps_lock_chk = false;
}
}
void periodic_callbacks__20Hz(void) {
bool ret_val1 = false;
bool ret_val2 = false;
bool ret_val3 = false;
bool ret_val4 = false;
bool ret_val5 = false;
get_waypoint_update_100hz();
ret_val1 = geo_status_tx();
ret_val2 = current_gps_position_tx();
ret_val3 = chkpt_gps_position_tx();
ret_val4 = geo_angle_delta_tx();
if (gps_lock_chk) {
ret_val5 = geo_lock_tx(1);
} else {
ret_val5 = geo_lock_tx(0);
}
if (ret_val1 && ret_val2 && ret_val3 && ret_val4 && ret_val5) {
gpio__toggle(board_io__get_led2());
}
debug_sensor_counter_tx(debug_gps_counter_pass, debug_gps_counter_fail, debug_CMPS_counter_pass,
debug_CMPS_counter_fail);
}
void periodic_callbacks__100Hz(uint32_t callback_count) {
if (callback_count % 5 == 0) {
periodic_callbacks__20Hz();
}
}
There are some extra counter found here, those will be explained in next section.
Technical Challenges
Some debugging was needed for my GEO node. It was suspected that COMPASS & GPS were parsing but there might be some failure rate. So, some debug pass/fail counter were created for CAN_bus to check whether it is true or not. It was right and there were some issues with GPS parsing. There was almost 20% fail rate while parsing and found some issue with line-buffer development fixed that and with increased buffer size and the GPS parsing fail rate reduced to less than 1%.
Driver ECU
<Picture and link to Gitlab>
The driver node a.k.a the MCU for the MCUs is a critical unit that needs high importance. Since all the nodes will interact with driver node, it is important that CAN message reception and transmission is always operational in the desired manner.
The function of the driver node is to: Run obstacle avoidance Manage CAN reception and transmission of CAN bus data from all nodes Interact with sensor data from other nodes and process the relevant data locally Print and display diagnostic data on the LCD display
Hardware Design
Software Design
We carefully thought over what data needs to be sent and received over each of the periodic callbacks. It was ensured that there is not too much of an unnecessary overload high frequency callbacks as it may consume more than 1000 ms and force reboot the MCU. In our design, we used `periodic_callbacks__1Hz` for low priority operations, `periodic_callbacks__10Hz` for more critical operations, but not the most time sensitive applications such as sonar and compass sensing. At 10 Hz, we are reading out the GPS data that include the present location, distance to checkpoint, and distance to destination. In 20 Hz callback, we are reading out the compass and sonar sensor data. It was observed that the response rate of the car towards obstacle improved significantly when the sensors were read at atleast 20 Hz. Since our car was controlled to move to 8.5 km/hr, the reaction time of the car from an obstacle needs to be fast at this point in time. Hence, the driver node reads the data at 20 Hz periodic callbacks.
void periodic_callbacks__20Hz(uint32_t callback_count) { can__rx_20Hz(); can_handler__manage_mia_20hz(); DP__obstacle_avoidance_processor(get_decoded_sensor_data()); can__tx_motor_commands_20Hz(); }
OBSTACLE AVOIDANCE
Obstacle avoidance is one of the most important aspect that enables the car to reach the destination. A robust obstacle avoidance algorithm enables the car to dodge the obstacle and move towards the destination in a smooth manner. If the car is made to turn right/left with maximum degree, then the car will make abrupt turns and make the obstacle avoidance less smoother.
To solve this issue, we added an intermediate left and right turn that lies in between a full turn and straight direction.
Obstacle Avoidance Logic
There is infinite possibilities for an obstacle to arrive while the car is in motion. It is impossible to hard-code the obstacle scenarios for obstacle avoidance. Therefore, a smart approach will be to use a truth table listing the possibilities of obstacle with respect to sensors.
void DP__obstacle_avoidance_processor(const dbc_SENSOR_SONARS_s sensor_data) { if (get_decoded_GEO_STATUS_data().GEO_STATUS_DISTANCE_TO_CHKPT < 2) { stop_car_destination_reached(); } else if (OA__is_obstacle_detected(sensor_data)) { OA__run_obstacle_avoidance_algorithm(sensor_data); } else { OA__follow_destination(get_decoded_GEO_STATUS_data().GEO_STATUS_BEARING_ANGLE_TO_CHKPT - get_decoded_GEO_STATUS_data().GEO_STATUS_COMPASS_ANGLE); } } void OA__run_obstacle_avoidance_algorithm(const dbc_SENSOR_SONARS_s sensor_data) { if (OA__is_middle_sonar_in_emergency_range(sensor_data)) { ReverseAdd_7(); processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_LEFT; processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_BACKWARD; can__tx_motor_commands_20Hz(); reverse_flag = true; } else { if (OA__is_middle_sonar_less_than_threshold(sensor_data) && OA__is_left_and_right_sensors_less_than_threshold(sensor_data)) { ReverseAdd_7(); processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_LEFT; processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_BACKWARD; can__tx_motor_commands_20Hz(); reverse_flag = true; } else if (OA__is_right_sonar_less_than_threshold(sensor_data) || ((OA__is_right_sonar_less_than_threshold(sensor_data) && OA__is_middle_sonar_less_than_threshold(sensor_data)))) { processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_LEFT; processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_FORWARD; can__tx_motor_commands_20Hz(); reverse_flag = false; } else if (OA__is_left_sonar_less_than_threshold(sensor_data) || ((OA__is_left_sonar_less_than_threshold(sensor_data) && OA__is_middle_sonar_less_than_threshold(sensor_data)))) { processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_RIGHT; processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_FORWARD; can__tx_motor_commands_20Hz(); reverse_flag = false; } else if (OA__is_left_sonar_less_than_threshold(sensor_data) && OA__is_right_sonar_less_than_threshold(sensor_data)) { ReverseAdd_7(); processed_commands_to_motor_node.MOTOR_CMD_steer = STEER_STRAIGHT; processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_BACKWARD; can__tx_motor_commands_20Hz(); reverse_flag = true; } else if (OA__is_middle_sonar_less_than_threshold(sensor_data)) { if (sensor_data.SENSOR_SONARS_left > sensor_data.SENSOR_SONARS_right) { processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_LEFT; processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_FORWARD; can__tx_motor_commands_20Hz(); reverse_flag = false; } else { processed_commands_to_motor_node.MOTOR_CMD_steer = TURN_RIGHT; processed_commands_to_motor_node.MOTOR_CMD_drive = MOVE_FORWARD; can__tx_motor_commands_20Hz(); reverse_flag = false; } } } }
Technical Challenges and Lessons Learnt - Advice to future students
Since the driver node is completely dependent on the sensors, firstly - it is important that the sensors are integrated and fixed as early as possible.
1. In our case, since the sensors were not ready in the early weeks, we followed a completely TDD approach where we wrote the code along with the test cases. Since TDD is like a simulation of the algorithm, it gave us the confidence that the obstacle avoidance algorithm would work even without the sensors. So, use TDD as much as possible.
2. Do not use hypothetical sensor threshold values. Take the car out, make it run and then decide what is the ideal threshold value. At early stages, while designing the algorithm we assumed that threshold of 50 cm would be sufficient for an obstacle avoidance. We soon realised, that the thresholds vary largely as it is directly proportional to the speed of the car. More the speed, larger the threshold.
3. Obstacle avoidance is all about trial and error and practical testing. Get the sonars integrated as early as possible, and get the car running in the field.
4. LEDs are free, use it lavishly. Since driver node interacts with all other nodes, it becomes very difficult to debug and realise if the reception from and transmission to other nodes is successful from the driver’s perspective. It is difficult to always connect BusMaster just to detect if reception and transmission is working. Flashing a particular LED that is assigned to a particular node will quickly help in detecting the faulty node.
5. Use multiple thresholds - hard stop threshold and safe threshold to prevent the car from generalising all obstacles as one. Sometimes, a hard stop is needed when the obstacle is suddenly too close to the car.
Mobile Application [Tushara]
<Picture and link to Gitlab>
Hardware Design
Software Design
<List the code modules that are being called periodically.>
Technical Challenges
< List of problems and their detailed resolutions>
Conclusion
This remote control (RC) project served as a canvas to showcase our problem-solving abilities and our adeptness in design. It required each team member to exemplify leadership qualities by independently managing their tasks and ensuring the effective operation of their modules, often with minimal supervision and scarce assistance. Emphasis was placed on the generation of clean code and comprehensive unit testing, along with the need for excellent design and composure during challenging circumstances. Collectively, we fulfilled the set expectations and successfully developed an autonomous electric vehicle, an accomplishment that fills us with immense pride. Our love for our craft and our pursuit of continual improvement became our most formidable asset throughout this journey.
Our autonomous electric vehicle was heavily influenced by models such as Silver Arrow and Road Runner. The integration of all modules via CANbus mirrored strategies adopted by renowned companies such as Ford, BMW, and Tesla, addressing our concerns related to signal integrity. The creation of the D.B.C file provided us with a profound understanding of the composition and transmission of CAN messages among the vehicle's modules. The development and integration of the Android mobile application shed light on wireless communication and the comparative advantages of Wi-Fi, Bluetooth, and Bluetooth Low Energy. Despite limited face-to-face interactions and time constraints, the assembly of all sensors and modules was accomplished, with the finished vehicle demonstrating admirable performance.
This semester has been one of the most educational and fulfilling experiences for us, offering practical insights that we believe would impress industry leaders like Elon Musk. We express our gratitude to Preet, Tudor, and Kyle for their relentless efforts throughout the semester, and to our peers for partaking in this shared journey. Despite the prevailing difficult circumstances, we are confident about the future, anticipating the advent of a predominantly electric era.
Project Video
Project Source Code
Advice for Future Students
- Incorporate a mobile kill-switch mechanism to effectively halt the car's movement. This feature becomes particularly useful in situations where the car may exhibit unexpected behavior or operate at high speeds, providing the ability to remotely disable it wirelessly.
- Enhance the RC car's functionality by integrating a range of LED indicators. These indicators can serve multiple purposes, such as indicating GPS lock, app connection status, obstacle detection, and arrival at the destination. Including ample LED indicators enhances the user's understanding of the car's current state and actions.
- Modify the code to deactivate the on-board LEDs for each controller during the periodic_callbacks__initialize() phase. The existing code, which illuminates the LEDs in the peripherals_init() stage, can be adjusted to turn off the LEDs after initialization. This adjustment allows for the convenient use of LEDs as indicators, providing visual cues to detect unexpected board resets.
- Ensure the stability of compass readings by implementing appropriate measures. Calibration of the compass is crucial for accurate readings. Additionally, it is important to verify that tilting the car does not significantly impact the magnetometer readings. Mounting the compass module away from metal and any sources of hard or soft iron that could introduce inaccuracies helps in achieving reliable readings.
- Conduct unit testing on code modules to validate their expected behavior. Through rigorous testing, it becomes possible to ensure that each code module functions as intended, contributing to the overall success of the project.
- Perform outdoor testing in a suitable environment, such as a garage, once the car is capable of movement. This allows for a comprehensive assessment of its performance in real-world conditions.
- Take into account the limitations of ultrasonic sensors when testing in hallways, as they may provide inaccurate readings at steep angles. Furthermore, compass readings tend to be more precise when tested outside the building, where interference is reduced. Adjust the testing approach accordingly to account for these factors.
- Above all, maintain confidence in your abilities. Although the project may appear daunting, it has been carefully laid out by Preet, providing incremental milestones that gradually come together to create a complete and successful project. Trust in your skills and the structure of the project to overcome any challenges that may arise.
Acknowledgement
We would want to thank our instructor, Preet, for inspiring us to learn and solve challenging difficulties. We'd also want to thank him for sharing his professional knowledge and presenting us with a class and project that will help us and our future success in the business.
References
1. Ultrasonic Sensor Documentation
2. GPS Sensor Documentation
3. CMPS12 Datasheet
4. LCD Datasheet
5. LCD Display Initialization and Configuration Example Tutorial
6. LCD Display Implementation and Flowchart Tutorial