Add SoftwareServo library expanded for ioexpander.h
Fixing up SoftwareServo to work in modern arduino
Smattering of SoftwareServo::refresh() and output shortening