Fixed issues with startup file in Keil

Simple linker issues
Also had strange issue with INFINITY equality that wasn't revealed until
now