Added an inverse subtract, and fixed bug causing segmentation faults when the arduino is unplugged than the program is exited.