Merged obstacle_avoidance_protocol aka. Pius-protocol form debra's repo.