|
@@ -722,7 +722,7 @@ struct car_point_filter:select_point_object
|
|
|
// turning angle must be correct
|
|
|
if(angle*delta>0 && fabs(angle)>fabs(delta)*detect_para)
|
|
|
{
|
|
|
- printf("turning:(%.5f,%.5f)(%.5f,%.5f)(%.5f,%.5f),a1:%f,a2:%f,delta:%f,angle:%f\n",
|
|
|
+ log_info("turning:(%.5f,%.5f)(%.5f,%.5f)(%.5f,%.5f),a1:%f,a2:%f,delta:%f,angle:%f\n",
|
|
|
pt1.x,pt1.y,l.v[0].x,l.v[0].y,l.v[1].x,l.v[1].y,angle1,angle2,delta,angle);
|
|
|
m_if_turning=true;
|
|
|
m_turning_pt.set(l.v[0]);
|
|
@@ -975,12 +975,12 @@ struct smooth_tool_car_1:smooth_tool
|
|
|
std::vector<point> path=card_path::inst().find_path(smooth_last_true_position, pt);
|
|
|
if(!path.empty() && smooth_last_true_position.dist(path[0])>200)
|
|
|
path.clear();
|
|
|
- printf("generating critical point in smooth(car):(%.2f,%.2f)->(%.2f,%.2f)\n",
|
|
|
+ log_info("generating critical point in smooth(car):(%.2f,%.2f)->(%.2f,%.2f)\n",
|
|
|
smooth_last_true_position.x, smooth_last_true_position.y, pt.x, pt.y);
|
|
|
if(!path.empty())
|
|
|
{
|
|
|
point critical_point=path[0];
|
|
|
- printf("critical point generated in smooth(car):pt=(%.2f,%.2f),(%.2f,%.2f)->(%.2f,%.2f)\n",
|
|
|
+ log_info("critical point generated in smooth(car):pt=(%.2f,%.2f),(%.2f,%.2f)->(%.2f,%.2f)\n",
|
|
|
critical_point.x, critical_point.y, smooth_last_true_position.x, smooth_last_true_position.y,
|
|
|
pt.x, pt.y);
|
|
|
init_pt.set(critical_point);
|