Agent_back(): agent with a larger safety radius
Agent_up(): agent with a smaller safety radius
constraint_agent(): polynomial for chance collision avoidance among agents
constraint_obs(): polynomial for chance collision avoidance with obstacles
shift(): system dynamic with external disturbances
high_order(): high-order moment-propagation