Cooperative navigation using environment compliant robot formations