simple parameter (minor change)
bug in atan
multiple robots