fixed orientation issue at the end
implemented client side of current footstep rostopic