Ported FiringPin to cpp file