using ROS_DEBUG for prints instead of cerr
fixed a bug in which an action could be popped out of a plan list even if the list was empty. Still a segfault to fix