<!--- Provide a general summary of the issue in the Title above --> ## Detailed Description <!--- Provide a detailed description of the change or addition you are proposing --> Implement controls for inchworm style traversal in simulation ## Expected Behavior <!--- What do you expect to happen by implementing this change? --> Given target position, robot should be able to traverse a structure in simulation. ## Current Behavior <!--- What does the code currently do? --> Feature not implemented. ## Ideas on Resolution <!--- What are some ways to resolve this issue? -->