fix footstep transforms to origin frame
copy fixed point over from DRC to get better walking plans for Atlas
minor footstep tweaks