A Social Force Model for Multi-Agent Systems With Application to Robots Traversal in Cluttered Environments