COre is not freezing but the output is not working still #30
The main issue was that tpsScale in PID.c was not being set to a sane
value. close #30