Added Rviz_Test.c - this depends on a library in fiducials_rviz.