Rgb packet handling

A try at getting a better rgb packet handling with inspiration from hovren's pull request: https://github.com/OpenKinect/libfreenect2/pull/72

Its still a work in progress, but I wouldn't mind any feedback on the way :+1: