Changed millis() to use readCoreTimer

It was using plib's ReadCoreTimer() originally.