Debugging marker-align task actionlib errors, code cleanup in task_marker package