Fix for #32, assertion on clear_costmaps service call.

Same fix than for hydro-devel