Ported FiringPin to cpp

yay!!!