Some refactoring and code optimizations. Also added two new settings for startup procedure (TorqueLPFBandwidth and Timeout).

Updated to 1000Hz frequency.