rosrun scoutsim scoutsim_node chargetest
rosservice call /spawn_em 3.5 1.07 2.618 "em_0"
rosservice call /spawn_em 3.5 1.14 3.667 "em_1"