Implement & Test real Firmware Stack

• Implement real firmware stack and test the limit of the buffer and also how the connection is handled on connection loss etc.
  • see #2 (closed)
  • see #7 (closed)