Modified Master2arm to get rid of the one big sleep in PlanTrajToFoam. Other sleeps exist, but most should stay (or can be reduced possibly). Also, added arg --speed=DEFAULT