Added timer support

To measure step response. Will be used in conjuction with Matlab.