Cope with modes with multiple data items

Includes fix for color sensor RGB mode bug
Merge pull request #11 from lawrie/master

Cope with modes with multiple data items