GPS updated to output both twist and carcommand msgs