Ejemplo n.º 1
0
void motorsSetRatio(int id, uint16_t ratio)
{
  switch(id)
  {
    case MOTOR_M1:
      MOTOR1_TIM->CCR4=C_16_TO_BITS(ratio);
      break;
    case MOTOR_M2:
      MOTOR2_TIM->CCR4=C_16_TO_BITS(ratio);
      break;
    case MOTOR_M3:
     MOTOR3_TIM->CCR4=C_16_TO_BITS(ratio);
      break;
    case MOTOR_M4:
     MOTOR4_TIM->CCR3=C_16_TO_BITS(ratio);
      break;
  }
}
void motorsSetRatio(int id, uint16_t ratio)
{
  switch(id) {
    case MOTOR_LEFT:
      TIM_SetCompare3(MOTORS_GPIO_TIM_M3_4, C_16_TO_BITS(ratio));
      break;
    case MOTOR_REAR:
      TIM_SetCompare4(MOTORS_GPIO_TIM_M3_4, C_16_TO_BITS(ratio));
      break;
    case MOTOR_RIGHT:
      TIM_SetCompare3(MOTORS_GPIO_TIM_M1_2, C_16_TO_BITS(ratio));
      break;
    case MOTOR_FRONT:
      TIM_SetCompare4(MOTORS_GPIO_TIM_M1_2, C_16_TO_BITS(ratio));
      break;
  }

  return;
}