Logging added.
Initialization optimized.
Motor rotation tracking added.