C++ code to control GPIO pins.

Usage should be clear in main.cpp