I have strong experience of firmware development for microcontrollers using C language. I have taken a look into the code and I can help you resolve the issue.
Relevant Skills and Experience
Strong experience of firmware development for PIC, AVR, ARM MCUs. Currently working on NXP Kinetis L series MCU
Proposed Milestones
$30 AUD - Complete task