Why are you using CP_Firmata.h rather than regular Firmata.h ?