Displays trajectory
Testing
Seems to finally be working
Fixed display paths bugs
WORKS
Got dual tip visualization working
Foot now moves to floor correctly, with debug code still included
Cleanup
New test setup for random poses