An Rviz tool that visualizes a given geometry with the cursor and orients the object normal to objects in the scene - View it on GitHub