Initialization fuction

[pstephen43]

I recommend creating an initialization function in which all the calibrations are performed, dynamic memory is initialized etc. This can be called from main() before the program begins.