changes to receptacle position
Open loop version of master. Doesn't work b/c open loop, only for comparison
started coding triangle test