Removed function class checking to measure performance
Small modifications to the callbsck functions to reduce jitter.

All the calculations and moving of data is done after the outputs are
set.
Just som code cleanup