Goal cancel works

It cannot send the actionlib goal yet, but it can send the cancel
command after listening a message in the cancel topic.
Cancel topic now expects a string.

Previously it was using a pose also for cancellation. However, this was
not used. Now it's a string, and any string will cancel the nav goal.