Revert "Merging development to master branch"

Reverts COHRINT/cops_and_robots#1