Solution based on Descartes geometry of educational robot

• 教学机器人运动学的笛卡儿解法