Now Co2 is compared as a 2D object. Various changes and roslint
corrections.