实控第三周作业-轨迹生成器
作业要求
3、编程实现定位运动轨迹生成器
在task_trajectory_generator任务中增加代码来处理来自task_command_sender的定位运动命令new_cmd，按照该命令中给出的位置、速度、加速度、减速度，实现一个梯形加减速（原理见数控技术教材）的运动轨迹生成器，当达到目标位置时，把new_cmd.Done设为true，主程序检测到new_cmd.Done为true时将结束运行。
编程要求：
- 轨迹生成器的代码结构能充分体现出基于状态机的编程方法。
- 把第一个可以运行的版本发布到自己的github账号上，并不断优化和提交。
- 创建一个TODO.md文档写下自己的编程思路和下一步要做的工作。
作业作答
1）程序说明（包括README.md和TD.md）已上传到github仓库the_3rd_week，目前只写了一个第一个版本，比较简陋，后面会看情况改变假设条件并拆分程序，修改结构。
2）程序流程图如下
