collision-avoidance Sample code for "Fast Reciprocal Collision Avoidance Under Measurement Uncertainty"