simplify odom calculations and publish inverted odom

guardian_node - publishes inverted tf odom if parameter is set
guardian_controller.cc - simplify odom calculations
guardian_controller.h - linux terminal colors for prints; changed
defines