From 2fa290b4e7855305f0a11604498b96f8a11fd9d7 Mon Sep 17 00:00:00 2001
From: Kevron Rees <tripzero.kev@gmail.com>
Date: Sun, 13 Apr 2014 00:55:49 -0700
Subject: [PATCH] added velocity text to framewriter

---
 plugins/opencvlux/opencvluxplugin.cpp | 33 ++++++++++++++++++++++++++++++++-
 1 file changed, 32 insertions(+), 1 deletion(-)

diff --git a/plugins/opencvlux/opencvluxplugin.cpp b/plugins/opencvlux/opencvluxplugin.cpp
index 460e908..6e8aaad 100644
--- a/plugins/opencvlux/opencvluxplugin.cpp
+++ b/plugins/opencvlux/opencvluxplugin.cpp
@@ -414,8 +414,39 @@ bool OpenCvLuxPlugin::init()
 
 void OpenCvLuxPlugin::writeVideoFrame(cv::Mat frame)
 {
-	//if(speed > 0)
+	if(speed > 0)
 	{
+		std::stringstream str;
+		str<<"Speed: "<<speed<<" kph, lat/lon: "<<latitude<<"/"<<longitude<<endl;
+
+		std::string text = str.str();
+
+		int fontFace = cv::FONT_HERSHEY_SCRIPT_SIMPLEX;
+		double fontScale = 2;
+		int thickness = 3;
+
+		int baseline=0;
+		cv::Size textSize = cv::getTextSize(text, fontFace,
+									fontScale, thickness, &baseline);
+		baseline += thickness;
+
+		// center the text
+		cv::Point textOrg((frame.cols - textSize.width)/2,
+					  (frame.rows + textSize.height)/2);
+
+		// draw the box
+		cv::rectangle(frame, textOrg + cv::Point(0, baseline),
+				  textOrg + cv::Point(textSize.width, -textSize.height),
+				  cv::Scalar(0,0,255));
+		// ... and the baseline first
+		cv::line(frame, textOrg + cv::Point(0, thickness),
+			 textOrg + cv::Point(textSize.width, thickness),
+			 cv::Scalar(0, 0, 255));
+
+		// then put the text itself
+		cv::putText(frame, text, textOrg, fontFace, fontScale,
+				cv::Scalar::all(255), thickness, 8);
+
 		(*shared->mWriter)<<frame;
 	}
 }
-- 
2.7.4