Cope with modes with multiple data items

Includes fix for color sensor RGB mode bug. Modes such as RGB mode are still not very reliable as SoftwareSerial struggles to keep up with the data.