Walking Biped (4 Servos Per Leg)

6,580

111

28

This biped robot was 3D printed.

4 low cost servos (SG90 or SG91) per leg are used to control hip, knee and ankle pith and ankle roll.

The kinematic commands are written to be simply implemented in an arduino (mini). Few parameters are used to control the step length and the cadence.

These parameters can be modified using a cheap BT module (HC06).

Step 1: Mechanics

Simply print (or modify the iges files).

Adjust the position to the servo as follow :

  • Ankle roll : near the middle of the range of motion (90°).
  • Ankle pitch : near the middle or to allow more dorsiflexion (used during the swing phase). I have set this to 80° on mine (so you have 80° of plantiflexion (the foot goes to the floor) and 100° in dorsiflexion.
  • Knee pitch : near the full extension so 20° to avoid mechanical limits.
  • Hip pitch : near the middle, but you can allow more hip flexion than extension.

Step 2: Electronics

One two cell batterie (7.2V) is used.

The power for the servo is done by two LM7805 voltage regulator (one per limb).

The brain is a arduino mini clone.

One MPU6050 is not used for the moment (for future release)

And i modify the parameters thanks to a HC06 BT module.

Step 3: Walking !!!!

Frontal plane

To achieve a correct walking, first focus on the frontal plane.

It could be very simple,

T is a variable time between each loop,

KML is the amplitude of the ankle roll mouvement (between 5 and 15°), it depends on the location of the center of mass of your robot and feet with.

FD and FG are the zero position of the foot roll.

t=t+1;
if (t>100) {t=0;}

myservo7.write(FG-KML*sin(2*3.14*t/100)); // left foot

myservo8.write(FD+KML*sin(2*3.14*t/100)); // right foot

delay (T);

Yes it's just a sinus.

Adjust T and KML to allow the robot to lift the feet of the ground.

If KML is to low it will not be possible, if it is to high, he will fall.

Sagittal plane

On the picture, you can see the position of the joints according to the gait cycle.

The basic idea is to store the joints position in tables.

two parametres are used to define the amplitude of the movement.

KST is used for the hip

and KSW for the knee during swing.

The movement of the joint are simply written using linear function according to the % of the gait cycle.

void setkin(int FHD[],int FKD[],int FHG[],int FKG[],int KST,int KSW)
{

for (int i=0; i <= 5; i++) {

FHD[i]=-KST; // Hip flexion Right

FKD[i]=0; // Knee flexion Right }

for (int i=6; i <= 45; i++) {

FHD[i]=KST*i/20.0-5*KST/4.0;

FKD[i]=0; } //

for (int i=46; i <= 55; i++) {

FHD[i]=KST;

FKD[i]=0; } //

for (int i=56; i <= 80; i++) {

FHD[i]=-KST*i/10.0+65*KST/10.0;

FKD[i]=KSW*sin((i-55)/40.0*3.14); } //

for (int i=81; i <= 95; i++) {

FHD[i]=-3*KST/2.0;

FKD[i]=KSW*sin((i-55)/40.0*3.14); } // //

for (int i=95; i <= 100; i++) {

FHD[i]=KST*i/10.0-11*KST;

FKD[i]=0; } //

// The second limb is obtained with a time simetry

for (int i=0; i <= 49; i++) {

FHG[i]=FHD[50+i]; // Left hip flexion

FKG[i]=FKD[50+i]; // Left knee flexion }

for (int i=50; i <= 100; i++) {

FHG[i]=FHD[i-50];

FKG[i]=FKD[i-50]; } }

Ankles :

if you just read the picture, ANKLE=-HIP-KNEE

this allow to keep the foot parralel to the ground in the sagital plane.

Share

Recommendations

  • Growing Beyond Earth Maker Contest

    Growing Beyond Earth Maker Contest
  • Frozen Treats Challenge

    Frozen Treats Challenge
  • Fandom Contest

    Fandom Contest

28 Discussions

0
None
mr.czik1996

Question 22 hours ago

Hello. Can you explant how to connect the blutooth or wht app are you using ?

0
None
robopathshalarobopathshala

Reply 2 years ago

ok bro can to provide me the flow chat of ur code becz m not familiar with arduino

0
None
dvyasrobopathshala

Reply 2 years ago

alok014 if you want to make s simple walking biped, i have written a walk cycle. Mag me if you want.

0
None
bonnetxdvyas

Reply 2 years ago

I'm interrested too!

0
None
bonnetxrobopathshala

Reply 2 years ago

It's maybe the hardest part!

I just adjusted the default position to have the knee in full extension and the center of pass of the robot near the middle of his feet.

You can push the torso a little bit to evaluate the stability in standing position

0
None
robopathshala

2 years ago

in ur code hip flexion is not working for serial communication

0
None
robopathshala

2 years ago

can u generate simple walking code only

plzzzz bro

0
None
robopathshala

2 years ago

u r not using i2c but the code is present in arduino file

0
None
rroque17

3 years ago

Hello,

I downloaded the igs file and converted into stl which most 3dhubers used. This is one stl file with all the parts combined together including the servo model. They are molded together and are very hard to print separately. Can someone recreate stl files with separate parts as shown in the drawing above. Two separate parts for the Green hips and foot. Three separate parts for the the burgundy knee, shins and ankle. Minus the black servo parts. So 5 stl files total.

Having an stl file for each part will be the quickest way to get a quote on 3d printing.If someone has 3d printed via the igs file, can you please send me instructions rroquetest@gmail.com

1 reply
0
None
bonnetxrroque17

Reply 3 years ago

I added the STL files for one leg (the right one), make a symetric print to obtain the other leg

0
None
BrBarry_sdb

3 years ago

Where did you get the calculations from? I'm working on a similar Biped, however I'm using (trying to) an SD21 Servo board via I2C to a UNO board. So the servo write is diferent.

I'm using the SD21 because I can add more servos, I also would like to add hip rotation so I can walk in circles.

1 reply
0
None
bonnetxBrBarry_sdb

Reply 3 years ago

The calculations came from observations....

You can find biomechanical studies of gait which gives the hip, knee and ankle mouvement in the sagittal plane. I modified if to obtain similar curves but easily adaptable to arduino.

Good luck with your project and send some video!

To achive foot lift, you will have to adjust the time of the frontal cycle and the amplitude of the prono-supination at the ankle.

0
None
harshc1

3 years ago

Can you explain how to connect the servos to arduino ????????? Please tell I really want to make it..........

0
None
ParodyC

3 years ago

hello, can you send for me code walking not blutooth? (only walking)

1 reply
0
None
bonnetxParodyC

Reply 3 years ago

You can use the same code, but use the usb serial port. It will work.

The BT connection is usefull to avoid cables.

0
None
rroque17

3 years ago

Hello,

Can someone give instructions on downloading and printing the

IGES files.igs. Maybe please zip it and convert to stl and repost it here.

0
None
rroque17

3 years ago

Hello,

Can you please zip the IGES files.igs. I am having problems downloading it.

What servo did you use (looks like a Hitec model)?