void display_velocity(double vx, double vy, double vz ) {
cv::Mat speedometer = cv::imread("../res/blank_speedometer1.png", 1);
double vel_abs = sqrt(vx*vx + vy*vy + vz*vz);
double slope_angle = (-vel_abs*300.0)/vmax + 45.0;
cv::Point center = cv::Point(speedometer.rows/2.0, speedometer.cols/2.0);
double del_x = 100*cos(slope_angle*_PI/180.0);
double del_y = 100*sin(slope_angle*_PI/180.0);
cv::Point end_point = cv:: Point(speedometer.rows/2.0 + del_x , speedometer.cols/2.0 + del_y);
cv::Point txt_pt = cv:: Point(speedometer.rows/2.0 -65,speedometer.rows/2.0 +75 );
std::stringstream ss;
ss << vel_abs;
std::string text = ss.str();
int fontFace = cv::FONT_HERSHEY_SCRIPT_SIMPLEX;
double fontScale = 0.75;
int thickness = 2;
cv::putText(speedometer, text, txt_pt, fontFace, fontScale, cv::Scalar::all(255), thickness, 8);
cv::circle( speedometer, center, 5,cv::Scalar( 0, 0, 0 ), -1, 8 );
cv::line(speedometer, center, end_point, cv::Scalar (255 ,0 ,0), 3, 8, 0);
vel.clear_overlay();
vel.set_image(cv_image <bgr_pixel>(speedometer));
}
void image_window_set_image (
image_window& win,
object img
)
{
if (is_gray_python_image(img))
return win.set_image(numpy_gray_image(img));
else if (is_rgb_python_image(img))
return win.set_image(numpy_rgb_image(img));
else
throw dlib::error("Unsupported image type, must be 8bit gray or RGB image.");
}
void image_window_set_image_simple_detector_py (
image_window& win,
const simple_object_detector_py& det
)
{
win.set_image(draw_fhog(det.detector));
}
void image_window_set_image_fhog_detector (
image_window& win,
const simple_object_detector& det
)
{
win.set_image(draw_fhog(det));
}
void add_overlay_parts (
image_window& win,
const full_object_detection& detection,
const rgb_pixel& color
)
{
win.add_overlay(render_face_detections(detection, color));
}
void add_overlay_rect (
image_window& win,
const rectangle& rect,
const rgb_pixel& color
)
{
win.add_overlay(rect, color);
}
void add_overlay_drect (
image_window& win,
const drectangle& drect,
const rgb_pixel& color
)
{
rectangle rect(drect.left(), drect.top(), drect.right(), drect.bottom());
win.add_overlay(rect, color);
}
