Updated code partially for Rev10, no IR/Lights working