Tested successfully with hardware; SoftwareSerial needs to be fixed, though.