Heuristic Predictive Control for Multi-Robot Flocking in Congested Environments