Fix for #32, assertion on clear_costmaps service call.

Same fix was applied hydro-devel sometime ago