Fixed the legIK for real and tested