Receive mode and build packet working

Just need you to implement the write mode function