PCA9856 now working

Debugged PCA code, now working!