Angular Velocity added in motorencoder.c / .h