第四次作业

两轴平面直角机械手的控制功能模块设计
功能要求：
 根据仿真环境提供的冰球当前的运动状态，制定运动策略，确定击球点。
 发送运动控制指令给机械手控制器，使其能在给定时间点，在预期的位置以预期的速度击打到冰球。
 机械手控制器解析并执行运动控制指令，并通过轨迹插补和加减速控制使运动平滑。

模块设计:
建立冰球类和击球器类。冰球类的内容主要包括冰球的位置坐标，速度，实时显示；击球器类主要包括击球器的位置，速度，功能包括接受指令，规划轨迹，实时显示
关键算法：