Added back timing functions to ino file.

Will use as template for timing