useful line drawing rviz code