A controller that checks constantly for the self-collison and writes to a safety interface so the hardware can act accordingly - View it on GitHub