Made telemetry period adjustable with a default of 50ms. Added comments to some of the more obscure code