Cope with modes with multiple data items

Includes fix for color sensor RGB mode bug