added traj for walking
added real walk in place