Fix RGB packing to match hardware
This isn't in the best state, but it's what I have right now