use Eigen::Vector3f in footstep_marker because of the change of the api
of jsk_pcl_ros