Biped Coding Issues

Hello,

I suggest you start from scratch again! Put the complex maths aside for now, concentrate on the logic first, use lots of Serial.print to debug your logic until it does exactly what you want, only then you put the maths in :slight_smile:

Also some tips:

Use functions arguments, for example not ik2() but ik2(x, y).
Use understandable variables/functions names.
Do not use delay().