Modified RPi Serial code to use wiringPi