To balance a robot on two wheels at its normal position and control its movement through an Android app.
The aim of this project is to make an automated vehicle that balances itself without any outside help or support. This project is a rather complex one as it involves using PID Control and involuted programming. Self-balancing robots are unique among all others, just because of their ability to balance on a given fixed position. Even if the robot is displaced from its position, it is programmed so that it again recovers its position.
On Robot: Bluetooth, PID, TIMER Interrupt, Kalman Filter, Communication protocol (serial and I2C).
MPU6050: MPU6050 is a three-axis accelerometer and three-axis gyroscope Micro Electro-mechanical system (MEMS). It aids in the measurement of velocity, orientation, acceleration, displacement, and other motion-related features.
Arduino Uno: Arduino UNO is a low-cost, flexible, and easy-to-use programmable open-source microcontroller board that can be integrated into a variety of electronic projects. This board can be interfaced with other Arduino boards, Arduino shields, and Raspberry Pi boards and can control relays, LEDs, servos, and motors as an output.
Drv8825 Motor driver: The Drv8825 is a complete micro-stepping motor driver with a built-in translator for easy operation. It is designed to operate bipolar stepper motors in full-, half-, quarter-, eighth-, and sixteenth-step modes, with an output drive capacity of up to 45 V and ±2.2 A.
Stepper Motor: Stepper motors are a type of DC synchronous motor. Whereas the rotation of an induction motor is largely uncontrollable, the rotation of a stepper motor can be controlled with a remarkable degree of precision. Stepper motors can produce full, instantaneous torque - even from a standstill.
ESP32: ESP32 can perform as a complete standalone system or as a slave device to a host MCU, reducing communication stack overhead on the main application processor. ESP32 can interface with other systems to provide Wi-Fi and Bluetooth functionality through its SPI / SDIO or I2C / UART interfaces.
Li-polymer battery: A lithium-polymer battery (LiPo) is a rechargeable battery that, in the case of true LiPo, uses solid polymer for the electrolyte and lithium for one of the electrodes. Commercially available LiPo is a hybrid: gel polymer or liquid electrolyte in a pouch format, more accurately termed a lithium-ion polymer battery.
Jumper wire : Jumper wires typically come in three versions: male-to-male, male-to-female and female-to-female. The difference between each is in the endpoint of the wire. Male ends have a pin protruding and can plug into things, while female ends do not and are used to plug things into.
MPU6050 Data: Initially MPU-6050 will measure the angle difference between the current position of the bot and its normal position. Now, this data is transferred to PID.
PID Tuning: PID will take input from MPU-6050 and accordingly calculate the PID value and give variable signals to both motors using interrupt service routine to bring the bot to its normal position and balance it.
Bluetooth Communication: Once the bot is balanced then we will send different commands ( forward, backward, turn left, turn right, and stop ) to the bot using Bluetooth communication to move the bot in different directions.
ISR Command: After receiving a command from Bluetooth, ISR will give different impulses to motors to move the bot according to the given command.
1. Turning the robot on.
2. The servo motor position is set to a minimum position to keep the robot in a standing position.
3. Receiving the data from Bluetooth.
4. Data is collected from the mpu-6050 and robot angle is calculated.
5. Data from MPU-6050 is filtered to remove the noise and make the data stable
6. Feeding the data in the PID controller and error is calculated by comparing it with the bot’s current angle and the balance point is delivered as output from the PID controller which will be in a linear data form.
7. Converting the linear PID balance point into a logarithmic balance point for running the stepper motor at variable speed.
8. Controlling the left and right motor separately.
9. a -->For controlling the left and right turn we changed the balance point of PID for both motors separately.
b -->For moving forward and backward we have changed the target angle where the robot has to balance. ex.-- Forward→increased target angle Backward→decreased target angle
10. Starting the loop again from 3rd point.
- The robot balances on two wheels.
- We can move the robot left, right, forward, and backward.
- Option to set the PID constants from the onboard knob as well as wirelessly from the Android application.
- The robot stands on its own with a servo motor for calibration when powered on.
- We can reset the robot wirelessly in case it falls on the ground.
- Used PORT control of Arduino for making the pin high and low as it is 60 times faster than the digitalWrite function of Arduino.
https://github.com/roboclub-mnnit/SelfBalancingBot-2022-23-Project
- Self-balancing algorithms can be used in rocket propulsion systems.
- Can be used in warehouses for moving goods.
- It can be implemented on Segway.
- It can be used for surveillance in any terrain.
1. MPU-6050 data has a lot of noise so we have a Kalman filter to smooth the data.
2. The setting of the PID value was frustrating when setting in code each time and checking the robot whether it is balanced or not. so we made three knobs to adjust the PID constant onboard without changing it in code and we also added this feature in the app so that the PID constant can also be set wirelessly.
3. Bluetooth connection gets lost regularly afterward we figured out that the input voltage was under 5v. So we powered the ESP32 directly with a battery with 11v.
4. When the potentiometer(for setting the PID constants) was powered with a 7805 voltage regulator(for 5v output) the robot oscillates as the servos were also connected to the 7805 and it drew a lot of power which made it undervolt(less than 5v) and the value of constants gets changed when mapped in Arduino code. So we powered it directly with 5v of Arduino to get stable 5v.
5. Earlier we used TIMER1 interrupt (ISR) but later realized that it was causing the problem as servo library we have used also use TIMER1 to make PWM signal and delay function in Arduino uses TIMER0 for delay function so we have used the this Arduino ISR i.e TIMER2 for creating interrupt for making Stepper motor impulse.
7. Stepper motor was not turning at a very high speed so we have chosen an ISR of 200us as full speed for the stepper motor.
8. The bot was getting resettled in the setup part of the code in which we had defined D13 as output and didn't work so we had defined the D13 as output in an “IF statement” in the loop part of the code.
9. To prevent the potentiometer and app PID constant from clashing with the original PID constant which we have set in code we have set a range so that we can deactivate the Potentiometer and app PID constant values when not needed and activate it only When the values Kp & Kd exceeds 10 and Ki exceeds 2.
10. Used PORT control of Arduino for making the pin high and low as it is 60 times faster than the digitalWrite function of Arduino and we have used it in ISR to make the impulse for driving the Stepper motor.
11. Detached the servo by software after running the main loop 200 times to prevent the oscillation of the servo and also prevent it further from drawing power from the battery.
12. Converted the linear output of PID value to nonlinear i.e in Logarithmic value to run the stepper motor at different speeds at different angles.
13. Controlled left and right Stepper motors separately for controlling the movement of the robot.
14. Made an Android app for controlling the movement of robots.
15. Separated the data coming from the app via Bluetooth in string form and stored it in different variables.
16. The PID error of Ki was getting very large and affected the responsiveness of the robot so we had limited it in range (-200 to 200).
17. There was a problem with the app that it was not showing any Bluetooth devices. Later we found that to connect it with Bluetooth it is first necessary to ask the app for accessing the phone’s Bluetooth. So we added the code in the app to ask for permission for accessing the Bluetooth from a user in the MIT app inventor.
Note-This issue will only be faced in Android 9+ devices
18. Microstepping was used for smoother operation of the stepper motor.
19. Always disconnect the Rx and Tx pin of the Arduino while uploading the code to Arduino.
-
Stepper motor control
-
Arduino
-
MPU6050
-
Battery
-
Servo motor
-
HC-05 Bluetooth module
-
PID Controller
-
Communication
-
Filter
-
Interrupt