Use rostopics for displaying shape during learning and getting feedback