Fixed motorctrl_t storage issue
Worked on fuzzy logic
Added btTest.c for testing