Performing datalog with variables of type double and SI units.
Converting from raw variables to SI unit variables in control thread.
Converting back command variables to raw variables for PWM.
Adding headers to datalog files.
Adding gain and offset for all variables to the configuration file.