Fixing memory leak in test_communication.c
Fixing memory leaks in the firmware side
Merge remote-tracking branch 'origin/master'