updated consensus centroid, swarm orchestra things, and gripper test code