Added robot count outputs

* Now outputs robot counts
* Greatly improved performance
