fixed point math for leg ik working