State of the system for Feb 05, 2014 IROS experiments. We're now cleaning the trajectory before sending it for execution by ensuring it's flat when it believes it's in contact, and decreasing the desired forces down to zero at the end of the trajectory for the scenario where the target's not on the constriant. There are more things we did, but I don't remember...