实现过程仍然是分为定义变量、初始化变量、实现控制算法函数、算法测试四个部分-Implementation process is still divided into the definition of variables and initialize variables to achieve the control algorithm functions, algorithms, test four parts