Creating test folder, tested receive thread

Created a small test program to test the receive thread from a Raspberry Pi. Fixed some bugs, and for now it performs as expected.