Reduced number of calls to mills() and micros()
Edited some comments etc.
Added space between arguments