Coordinated formation control design with obstacle avoidance in three-dimensional space.