Arduino Boat Autopilot - in Progress
2442 Views, 3 Favorites, 0 Comments
Arduino Boat Autopilot - in Progress
This project was created with the goal of creating a low-cost device for automatic navigation using the arduino mega microcontroller interface. The picture shows the finished device with all parts installed in the control box. 4 buttons installed on the control box, 1 rotary encoder and a remote control with 4 buttons are used to set and control the device. Steering is provided by the use of a stepper motor and a threaded rod, which enables the steering wheel to be turned by approximately 5 degrees in each direction.
Supplies
The power supply of the microcontroller and the stepper motor driver are separate. The main power source is the ship's batteries, which are charged using photovoltaic panels. The voltage on the accumulators is between 13 and 14 V which is fine for the stepper motor driver, but too high for the arduino microcontroller. Therefore, powermodule DC-DC 15-80 to 12V step-down power supply converter is used to power the microcontroller. Since the stepper motor driver is built into the control box, the heatsink part faces outwards to promote heat dissipation and reduce the heating of the microcontroller. The temperature in the control box is continuously controlled using a thermistor. In the event that the temperature exceeds a critical value (which can be adjusted in the device settings), an alarm is triggered and the operation of the stepper motor is disabled.The parts installed in the control box are shown in the picture.
** Used components: **
- TB6600 Single Axis 4A Stepper Motor Microstep Driver 9~40V Micro-Step - 1Pcs
- Nema 23 Stepper Motor 3Nm/1.9Nm/1.26Nm 4-lead 2.8A/4.2A - 1Pcs
- Beitian BN-800 Dual Module with Antenna Compass HMC5883L - 1Pcs
- Mini 12mm Waterproof Momentary ON/OFF Push Button Round Switch - 4Pcs
- 12mm Metal Push Button Switch Waterproof LED Light Momentary Latching - 1Pcs
- 24V / 12V to 5V 5A powermodule DC-DC step-down power supply converter - 1Pcs
- 315MHz/433MHz 4Buttons RF Remote Control - 1Pcs
- 4 Channel 433MHz RF Wireless Remote Control Learning Decoding Receiver Module - 1Pcs
- 3.2 Inch MEGA2560 Display Module HX8357B 480x320 TFT LCD Screen - 1Pcs
- 40 pcs Dupont Cables M-F Jumper Breadboard Wire GPIO Ribbon for connecting TFT LCD with Arduino MEGA - 1Pcs
- MEGA 2560 R3 Arduino komp. Mikrokontroller Board Atmel ATmega2560 - 1Pcs
- Several Dupont Cables M-F, M-M, F-F Jumper Breadboard Wire for wiring
- NTC 3950 Thermistor 100KOhm - 1Pcs
- Resistor 100kOhm - 1Pcs
- KY-040 Rotary Encoder Module - 1Pcs
Wiring the Components
The picture shows the wiring diagram. Arduino pins 22 - 53 connect to the corresponding pins on the TFT LCD screen
Arduino Code
The Arduino code is written in multiple files. All required files including arduino code and icons are attached below. The SD card to be inserted into the TFT LCD module slot must contain "*.raw", "POI.csv" and "Settings.txt" file. The "POI.csv" file contains points of interest. Points of interest can be changed using the text editor and adjusted to your own preferences. The "Settings.txt" file stores the settings of the navigation device, which can be changed from the program itself. The SD card should be enabled for editing files.
Downloads
Program Flow Diagrams - Initialization
Program Flow Diagrams - "manually" Setting the Neutral Position of the Rudder
Since the use of encoders is not provided for determining the initial position of the rudder, it is necessary to "manually" adjust the neutral position of the rudder before starting the automatic operation of the autopilot.
Program Flow Diagrams - System Parameter Settings
The program enables the setting of more system parameters than shown in the flowchart.
Program Flow Diagrams - Autopilot Main Menu
The main menu consists of six possible choices, two of which are hidden. The most important functionalities are navigation according to the given course and navigation according to the given destination. Applying navigation to a set course does not take into account drift due to wind and sea currents, making the final destination unreliable. In this case, the autopilot tries to maintain the given course. By applying navigation to the destination (set longitude and latitude of the destination), the course is corrected during navigation, i.e. calculated based on the current position and the position of the destination. This method of navigation is reliable, and the error depends on the precision of the GPS device (for cheaper devices, it is of the order of 10 m). The next functionality is the anchoring function. By calling this function at the moment of lowering the anchor, the current GPS position is recorded and the permitted deviation from the current position can be entered. If during the stay on the anchor there is a greater deviation than allowed (the anchor has loosened), an alarm (buzzer) is activated. By starting the microcontroller, multiple points of interest (POIs) stored on the SD card are loaded. The program enables the entry of one custom POI that can be used within the navigation function to the destination (fourth function in the main menu). The fifth hidden function refers to the manual control of the boat, which is achieved by pressing the button of the rotary encoder. Calling this function enables control using the buttons on the control box or using the remote control. The sixth function refers to the return to the home menu.
Program Flow Diagrams -
Starting the anchoring function automatically records the current GPS location. Then the input of the permitted deviation from the current position is requested. After that, monitoring of the position on the anchor is started. A circle is drawn on the screen, the radius of which represents the permissible deviation from the anchoring location (center point). The current position is plotted on the LCD screen and refreshed every 5 seconds. If the distance of the current location from the anchoring location is greater than the permitted deviation, an alarm is activated.
Program Flow Diagrams - Input Custom POI Coordinates
Custom POI can be entered by entering two digits at a time to speed up coordinate entry. Coordinates are entered in decimal notation. Each entry must be confirmed by pressing the button on the rotary encoder. The program provides for the input of coordinates with 6 decimal places, although the flow diagram shows the input of only 4 decimal places.
Program Flow Diagrams - Navigation to Destination
Navigation towards the desired destination is done by first choosing a destination from the available database stored on the SD card or a custom POI that has been previously defined. After selecting the destination, the current location is read and the course towards the destination is calculated. If the speed of the boat is higher than the minimum required, which is defined in the program settings, it is checked whether the deviation of the current course from the budget is greater than the allowed tolerance. If the course deviation is greater, the rudder is turned in the appropriate direction. The process is repeated after 5 seconds. If the deviation of the course from the budget is less than allowed, the rudder returns to the neutral position. In the loop there is also the possibility to return to the main menu. In this way, the maximum precision of the navigation path is ensured, regardless of the wind and sea currents, because the course is recalculated every 5 seconds ("course over ground").
Program Flow Diagrams - Navigation to Desired Course
Navigation towards the desired direction (course) starts with entering the numerical value of the desired course. After that, the current GPS position (previous position) is read. Then there is a pause of 5 seconds after which the new current GPS position (next position) is loaded. Based on the two read positions, the current exchange rate is calculated. If the speed of the boat is higher than the minimum required (defined in the system settings), the current and desired course are compared. If the deviation is greater, the rudder is turned in the appropriate direction. Then the next position is declared as the previous position and the loop is repeated. If the deviation is less than allowed, the rudder returns to the neutral position. In the loop, it is possible to return to the main menu.
Program Flow Diagrams - Manual Control
Starting the menu for manual control is done by pressing the button on the rotary encoder. This makes it possible to turn the rudder using the buttons on the device housing or using the remote control. The upper two buttons are used to gradually turn the rudder to the left or right, while pressing either of the lower two buttons returns the rudder to the neutral position. In the loop, it is possible to return to the main menu.