To receive notifications about scheduled maintenance, please subscribe to the mailing-list gitlab-operations@sympa.ethz.ch. You can subscribe to the mailing-list at https://sympa.ethz.ch

Commit bedae98d authored by widmerl's avatar widmerl
Browse files

added publisher

parent 56be9730
......@@ -208,9 +208,13 @@ while(cam.isOpened()):
rvec = rvec[0]
tvec = tvec[0]
QueryImg = aruco.drawAxis(QueryImg, cameraMatrix, distCoeffs, rvec, tvec, 100)
output = 'r: '+str(rvec[0])+' t: '+str(tvec[0])
cv2.putText(QueryImg, output, (0,20), fontface, fontscale, fontcolor)
cfcamera_pub.publish(0.5)
outputr = 'r: '+str(rvec[0])
outputt = 't: '+str(tvec[0])
cv2.putText(QueryImg, outputr, (0,20), fontface, fontscale, fontcolor)
cv2.putText(QueryImg, outputt, (0,50), fontface, fontscale, fontcolor)
else:
print('Wrong Marker detected at Frame: ' + str(framecount))
mask[0] = 1
......@@ -224,7 +228,7 @@ while(cam.isOpened()):
filtered, covariance = (kf.filter_update(filtered, covariance, masked_data[0]))
data_out = filtered
output = 'flt' + str(np.round(data_out, decimals = 2))
cv2.putText(QueryImg, output, (0,50), fontface, fontscale, fontcolor)
#cv2.putText(QueryImg, output, (0,50), fontface, fontscale, fontcolor)
# Display our image
cv2.imshow('QueryImage', QueryImg)
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment