Files' layout reorganization
Code cleanup
Added test code for MCU