Attempt to fix foundation.step offset and cleaning up a lot of pivot rotations. Adding foundation.triangle update