int numPoints = sizeof(myPoints) / sizeof(myPoints[0]); Point myPoints[] = { {1745,…
- User
int numPoints = sizeof(myPoints) / sizeof(myPoints[0]); Point myPoints[] = { {1745, 2042}, // point 1 {1715, 1785}, // point 2 {2060, 1770}, // point 3 {2090,2034}
}; void servo_degress_points_to_move(Point points[], int points_num, int step_tot, float step_time) { int loop = 1; int point_n = 0; int step_n = 0; int last_points_num = points_num - 1; while (loop) { float ro, pi; if (point_n == last_points_num) { ro = (points[0].ro - points[last_points_num].ro) / step_tot * step_n + points[last_points_num].ro; pi = (points[0].pi - points[last_points_num].pi) / step_tot * step_n + points[last_points_num].pi; } else { ro = (points[point_n+1].ro - points[point_n].ro) / step_tot * step_n + points[point_n].ro; pi = (points[point_n+1].pi - points[point_n].pi) / step_tot * step_n + points[point_n].pi; } laser_move_by_degress(ro, pi); step_n += 1; if (step_n > step_tot) { step_n = 0; point_n += 1; if (point_n > last_points_num) { point_n = 0; } } delay_ms(step_time); } } 最后调用此函数为servo_degress_points_to_move(myPoints, numPoints, 20, 500); 为我模拟每运行一次后ro与pi的值各为多少并打印出来直到point_n 重新等于0
- Assistant
在每次循环中,调用laser_move_by_degress(ro, pi)函数以移动激光,并设置延迟时间为step_time毫秒。
在调用servo_degress_points_to_move函数之前,需要先计算numPoints的值,即点的数量。
在函数servo_degress_points_to_move中,通过循环来控制移动激光到指定点的过程。当循环变量loop为1时,进行循环,直到point_n重新等于0。
在每次循环中,首先判断point_n是否等于last_points_num(即最后一个点的索引)。若是,则通过线性插值计算出ro和pi的值,分别为(points[0].ro - points[last_points_num].ro) / step_tot * step_n + points[last_points_num].ro和 (points[0].pi - points[last_points_num].pi) / step_tot * step_n + points[last_points_num].pi。
若不是最后一个点,则通过线性插值计算出ro和pi的值,分别为(points[point_n+1].ro - points[point_n].ro) / step_tot * step_n + points[point_n].ro和(points[point_n+1].pi - points[point_n].pi) / step_tot * step_n + points[point_n].pi。
接下来,调用laser_move_by_degress函数,将计算得到的ro和pi值传入,移动激光。
step_n自增1,表示前进一步。
若step_n大于step_tot(即步数达到总步数),则将step_n置为0,point_n自增1,表示进入下一个点。
若point_n大于last_points_num(即达到最后一个点后),则将point_n置为0,表示重新开始循环。
最后,通过delay_ms函数延时step_time毫秒,控制每次循环的时间间隔。
当point_n然后重新等于0时,循环结束。