This is ESP32 Based Balancing Robot

This is a fork of the "High speed balancing robot based on ESP32" created by Wouter Klop, Original code is here: https://gitlab.com/kloppertje/balancingrobot

The article that explains how this works is here: http://elexperiment.nl/2018/11/high-speed-balancing-robot-introduction/

This is the video how I built this robot: https://youtu.be/vPx2oyZGv50

Compile

Use 1.0.6 version of ESP32 Core https://github.com/espressif/arduino-esp32/releases/tag/1.0.6

Answers to your questions

!!! Read this issue to get common answers: #2 Or create a new issue :)

Mode

This modification of the code contains several changes, one of them is a simple ability to change the direction of the motors individually:

#define reverseLeftMotor true
#define reverseRightMotor false

Another change is the auto current control. It allows ESP32 to set current through the motors. This feature requires you to remove trimmer potentiometer on the DRV8825 module and solder a wire (see the circuit & photo)

Yet another noticeable change is the use of two sets of PID values for "standing" and for "going", this allowed the robot to stay without any movement. (I was not able to achieve perfect standing without movement just with one set of PID values).

Set this to "0" for automatic switching (Experimental)

uint8_t pidTypeApply = 1; // PID to use 0=auto, 1= go PIDs, 2= stay PIDs

Both PID value needs to be tuned separately which is "additional headache", so at first, it is the best just set it to "1" and use one set of PIDs. (Not sure that I implemented this feature correctly, but I am satisfied with the results)

Also I added INA219 module to monitor current and voltage. Good for telemetry. Also when the charger is connected it measures the capacity of the battery. INA219 uses I2C bus just like MPU6050

There are many small tweaks also.

This is the final curcuit:

Most of the stuff for this robot I bought on Aliexpress

Motors: https://s.click.aliexpress.com/e/_c4WVLv15

DVR8825 stepper motor driver: https://s.click.aliexpress.com/e/_c3ZBrKLV

Battery: https://s.click.aliexpress.com/e/_d8cDFDa 3 battery is needed to get 12V

Battery Holder: https://s.click.aliexpress.com/e/_c43gEmhD

Battery Protection Board: https://s.click.aliexpress.com/e/_DknQERR (3s 40a balanced)

DC-DC Converter: https://s.click.aliexpress.com/e/_c41fyYI7

ESP32: https://s.click.aliexpress.com/e/_c3VhEwTl

Hexagonal Coupling: https://s.click.aliexpress.com/e/_dZsbHNw (connects wheels to motors, 5mm)

Steppr Motor Bracket: https://s.click.aliexpress.com/e/_c4q9gSbN

MPU6050 Gyroscope & Accelerometer Module: https://s.click.aliexpress.com/e/_c4SNSi7N

INA219 Voltage & Current sensor: https://s.click.aliexpress.com/e/_c3PkW3dN

PCBs: https://s.click.aliexpress.com/e/_c3icY5Ar

Pin Header: https://s.click.aliexpress.com/e/_c2zNwZSn

Electrolytic Capacitor https://s.click.aliexpress.com/e/_A2atvx

Ceramic Capacitors: https://s.click.aliexpress.com/e/_c4F1Wrfh

Resistors: https://s.click.aliexpress.com/e/_9AslPB

I was using 1N5822 schottky diodes, just because I had them.

(some of the links are affiliate links)

I hope I did not forget anything :)

This project turned out to be a bit expensive, but I really wanted to make it. If you decided to build it I hope you know what you are doing, PID tuning is not easy... I'd say not for beginners, so good luck. I think the robot would be better if it was lighter and a bit smaller, but this assumption needs to be tested. Initially, I edited code in PlatformIO, but then I moved to Adruino IDE, for some reason OTA in Adruino IDE worked better, although I still get errors sometimes.

I must warn you that I am not a professional programmer, so there are probably much smarter ways to make all those changes. But all this worked for me, and I am happy with the results. The great thing about open source is that you can change the code the way you like it. Thanks Wouter Klop for making this possible, check his video as well: https://www.youtube.com/watch?v=D7hvI_Tb0o4