Brushless motors routines fixes