I was always fascinated with balancing robots and wanted to build one myself. Some time ago I started collecting IMU, arduino boards, wheels, motors for other wheeled robots and one day decided to build a balancing robot instead. I've used wheels from old four wheel drive robot that used mouse sensors for odometry and was driven by an Arduino Pro mini. That robot never went alive anyway :)
Originally the robot was built using Arduino pro mini and all it could do was balance. I was thinking to add BT module to control it until I discovered that I have ESP8266 lying around. Also I decided to use a better IMU algorithm instead of DPU of the MPU6050. Thus the ESPBalancingRobot was born. It does use DC motors to balance without any encoders. Speed is being estimated using PWM signal averaging and constant angle is maintained using a double stage PID controller.
Configuration before BuildingBefore building and uploading please create wificonfig.h
file with the following contents:
#define WIFI_SSID "ssid"
#define WIFI_PASSWORD "password"
#define ARDUINO_HOSTNAME "hostname"
If you fork the repo, you can still have this file as it is in .gitignore
and won't be added during commit.
PlatformIO was used to develop the code instead of Arduino IDE as I find it packed with much more features, therefore the structure of the project conforms to what PlatformIO expects. Flash the ESP module first before soldering anything. Also upload SPIFFS. After that it is possible to use OTA, just don't forget to configure ESP to connect to your local network. You can start assembling the robot.
By the way, it is possible to flash via OTA and even operate the robot even if it is not connected to WiFi. The robot will go into AP mode and will have an 192.168.4.1 IP address which you can connect to. Whatever you set as ARDUINO_HOSTNAME will be the AP name.
ConstructionWheel base consists of two geared motors, some scrap wheels and a 3D printed motor holder which is basically a tube with slots to hold wooden sheet. Later I added those blue pads so that the robot wouldn't suffer much after falling over.
Motor controllerI used a 1A motor controller based on L293, however chinese manufacturers seemed to be too secretive about the chip used... Even though they advertise it as L293 motor controller board on ebay :)
ElectronicsThe robot is powered by two LiIon batteries salvages from old laptop battery. There is a dc-dc buck converter that supplies 3.3V for electronics, some random power switch, ESP-1 module and an MPU6050 board. Also some pullups, capacitors and a trim potentiometer for battery monitoring (turned down to 1:10 ratio).
IMU was used a simple MPU6050 and can be seen under the ESP module. It is glued by hot glue to the battery holder. Alignment is not perfect, but staged PID adjusts for that.
The ESP-1 moduleFor robot control we need six pins(not counting ADC pin for battery monitoring): 2x for I2C, 4x for PWM control. As ESP-1 module clearly doesn't have enough pins we need to add those. With a very steady hand, small soldering iron, some flux and good eyes it is possible to solder those additional ports directly to the ESP chip pins. That was not an easy task to accomplish!
I used RX/TX pins for I2C as the chip emits some noise on those pins while booting and MPU doesn't seem to be upset about that. Although the motors might be.
Also I had to add pullUP resistors to GPIO0 and GPIO2 and a beafy capacitor on the 3.3V rail.
One thing to mention about the motors. For some reason one of my motor drivers and ESP modules during the early stages of the build just died on me. I figured that it had something to do with cheap motor driver burnup. So this time I added 1k resistors in series just to be safe.
Theory of operationMostly inspired by 5pqri1 EspWay balancing robot.
PID tuningIt is possible to tune PID controllers by building the firmware with
#define USE_LOGGING 1
somewhere in the beginning of the code. The UI changes somewhat and allows to see the realtime graphs of speed/angle values and also provides some sliders to set pid values. There are some issues, though with the ESPUI, as if I add all the controllers (for both PIDs), the ESP crashes. Also adding all the desired controls consumes to much flash size so the OTA doesn't allow to flash due to size limitations.
Comments