Bugfix, cleanup. Working RX/TX.