Finishes init, adds non-working rgb reading
Fixes color readings