Self Balancing Arduino Robot_PID

5,757

60

47

Posted

Introduction: Self Balancing Arduino Robot_PID

Two-Wheel Self Balancing Robot using Arduino and MPU6050 . Well guys I know its not a new type invention but still many hobbyist still love to see the electronics. I will go here with the cheap parts in order to keep minimum cost for all those young inventors who want to complete this instructable !! Savvy !!

Hats Off Lets go

Sorry for my english as it isn't my tongue language so beware and bear me for some moments.

Step 1: Collecting Items (Tiresome :P)

1. Arduino UNO in USA or Genuino outside USA

2. MPU 6050 Gyroscope from ebay

3. BO geared plastic motors (150-300 RPM)

4. L293D Motor Driver

5. Wheels

6. Capacitors of ceramic type (0.01uF)(not used here)

7. A charger (Wall charger USB type)

Note - Motors should be of high torque and speed as well. Torque is required to lift the weight when the bot falls on either side. If it wont have such required force then you might have to visit hobby shop again!! for better ones.Speed is required for a faster response to any change in bot from sudden jerks.

Step 2: Frame"Work"

Without any screws or bolts I am keeping here simple.

Take a (1 X 2 cm) strip of double sided tape and stick it to the ede of motor.

Similarly we will need four strips here. Two for each motor.

Then choose distance between motors. I generally keep it between 8-9 cms.

With a rotary cutting tool cut off rule of length 6cm from beginning.

We will do here same for two rulers.

Then stick the rulers keeping symmetry to both sides of motor.

I actually did this step so kinda lack my images. Well nothing to worry I have a completed one.

Step 3: Upperframe Work

As you can see in the above video how I managed to make a cardboard frame to fix it on the motor frame. You can choose any height. However I chose around 10.5 cms.

Now on each side as in picture you have to punch out two holes on each side of frame. They must remain aligned. We are going to fix the motor driver L293D on it. I have cutted out a piece of cardboard with dimensions. It is having 3 holes. Two for motor wires and the fron one for IC and power wires of shield.

Step 4: Full Body Assemble

In the video you can see how I have assembled this bot using just some tapes and band. Remember the bot must not be too heavy at the top as we are using low quality motors. High RPM with HIGH torque is preferred like the johnsson motor. RPM will help to bring robot back to its C.O.G position if tipped by a large angle and torque will help the bot to bear the weight above itself. So try to keep the height a bit low to keep the bot stable.

Step 5: Calibration

Open Arduino IDE and find the source code from this *link*

The code involves main code with I2C ino. Rename this code to I2C.ino.

Also download the Kalman filter library from TKJ Electronics Github.

Open the first link and then click sketch the add file. Select I2C.ino and add.

Now hold your bot still perpendicular as possible and note down the angle from serial monitor. Now in the source file use that angle as limit.

For circuit Motor Shield pins would go as

INT1 = D6

INT2 = D7

INT3 = D3

INT4 = D4

SCL = A5

SDA = A4

For a person like me who hates batteries I shorted 12V with 5v terminals on motor shield and powered them with charger 5V/1.55 A output. You may follow your own power method.

Thank you guys,

Instructable managed by Ambika and Shashi Cheers

Links Updated Guys !!! Comment to let me know if doesn't work

Step 6: Updates

Updated the code

Bot can now face some pushes

Some code changes introducing a better auto callibration.

Have a look on pic.

Will update code soon after some testing.

Links Updated

Share

Recommendations

  • Space Challenge

    Space Challenge
  • Microcontroller Contest

    Microcontroller Contest
  • Spotless Contest

    Spotless Contest
user

We have a be nice policy.
Please be positive and constructive.

Tips

Questions

41 Comments

I'm getting this error trying to upload your code.

Self_balance:130: error: unterminated #else

#ifdef RESTRICT_PITCH

^

exit status 1

unterminated #else

Can you post the complete code please.

Check the new link and let me know if it works.

I hope you have imported I2C and main code together. Savvy ??

Is your bot balancing ?

What problem are you facing ?

P.S I used the same link you provided however I noticed that by using complementary I was getting less torque thus making my bot to fall to either side hence I switched to Kalman.

P.P.S Balancing can even work without Kalman or complementary!

I can't compile the code I used this file

https://github.com/vu2aeo/Arduino/blob/master/BalanceBot2_PID_Control/BalanceBot2_PID_Control.ino

BOmotor library: https://github.com/vu2aeo/Ard-Class/blob/master/BOMotorPair/bomotorpair.h

MPU6050 library: https://github.com/vu2aeo/Ard-Class/blob/master/MPU6050/MPU6050.h

Now when I try to compile them I get this error

BalanceBot2_PID_Control:46: error: 'class MPU6050' has no member named 'GetGyroReading'

float g = sensor1.GetGyroReading(1);

^

BalanceBot2_PID_Control:48: error: 'class MPU6050' has no member named 'GetAccelerometerReading'

float a = sensor1.GetAccelerometerReading(0);

^

exit status 1

'class MPU6050' has no member named 'Initialise'

What changes I have to make to the code?

Import correct header file

Correct MPU6050 code link is this

https://github.com/vu2aeo/Ard-Class/blob/master/MPU_6050/mpu6050.h

Alright the program compiled fine but I am not getting any response from the robot. In serial monitor only this line shows up.

WHO_AM_I : 68, error = 0

TX and RX on arduino are not blinking at all

error 0 is for successful working however it means that gyro module is working and giving you raw values but these raw values haven't been converted to something meaningful. Its just raw values.

Hello, my problem is that when the robot to one side turn the 2 wheels to balance, but when it falls to the other side only one wheel rotates to balance and the other wheel stays still.

What can I do to correct this?

Pd: sorry for my English.