Use env model server

support footstep planning ON planes