Close

C# Inverse kinematics -

A project log for 3DOF Hexapod (Hexapi)

Hexapod using Inverse kinematics with a Raspberry PI 3 brain, XBox 360 Wireless controller running on Windows 10 IOT Core. (3d printed legs)

Larry W.Larry W. 05/28/2016 at 13:510 Comments

After much tweaking and re-writing the IK and SerialPort code, the gait is much improved. I still need to figure out why the _bodyPosY or height has odd results the closer it is to the ground. However, the code is in a very usable state.

I was also able to figure out a reliable way to query the SSC-32U for the movement status, and base the gait timing on that status. Makes for a much smoother gait.

SerialPort.ReplyCallback = b =>
{
Task.Factory.StartNew(async () =>
{
if (b == 0x2e) //0x2e = .
{
InverseKinematics.SscCommandCompleteEvent.Set();
return;
}

await SerialPort.Write(_querySsc);
});
};

Then:

SscCommandCompleteEvent.Wait((int)(_gaitSpeedInMs + 75)); //Timeout
SscCommandCompleteEvent.Reset();

There may be a better way than using the manual reset event, but I have yet to find it.

Discussions