First working version of sensor and sensorharness for SoftwareSerial