Write error fixed

Currently testing connection, subscription and sending to UART.
Get connected to device.
Subscription fails.
Send does not do anything yet