New config and HT with fixes
Prevent buffer overflow in a crude way
Kalman: Thanks to Donovan Baarda