Update to SerialPortHandler after testing with Arduino (wip)