Added averaging mechanism for gyroscope. Tested & seems to work.
NB need to finish system for max/min accel readings.