Fixed the system clock to count 1ms properly at 25MHz core clock