TE compensation

First try at TE compensation. Currently the filtering of
read_climb_rate() is causing a phase lag between the acceleration and
climb rate that needs to be dealt with.
added logging

First crack at logging.