利用坐标变换求出旋转后的足端位置，然后通过逆运动学求解髋关节和膝关节角度需要注意的是，当离地高度确定后，俯仰角有最大最小值，需要确保其在允许范围内。