ZMP based Cycloid walking algorithm for Darwin-OP
This Tutorial assumes you have some background in ZMP walking algorithms.
A quick recap of what is ZMP:
ZMP or Zero Moment Point is the point on the humanoid robot's foot where the moment due to the forces and moments acting on the robot is neutralized.
This ZMP(the zero moment POINT) must always lie within the in the robots's support polygon for the robot to keep balance.
The concept of cycloid walking was used to impliment ZMP walking.
For the Darwin-OP in sitting position the COM is at a height of 208.12mm from the ground.
The natural frequency of the robot was found out to be 1.092Hz.
Thus the time period of the robot's steps are .9156sec.
The next step in making the Darwin-Op walk is to generate trajectories for the motion of the COM and the ankle. To generate this Matlab was used.
Walking Specs Used:
Full Step Length : 25 mm
Step Height : 35mm
Step Time : 0.9156 sec (time for two steps,i.e. the period of walk)
Single support time period : 75% of Time period.
Double support time period : 25% of Time period.
A plot of these trajectories is shown in the pic below.
These trajectories are then used to generate the trajectory points for each leg joint that will make the robot walk. This was done using Inverse kinematics for the Darwin-OP. This plot is shown in the pic below.
Joint angle trajectory for each leg separately