Cooperative Coordination and Formation Control for Multi-agent Systems