IK now good enough for walk engine testing. Some generalisations need to be made but otherwise working for all required positions.