int motorsGetRatio(int id)
{
  switch(id) {
    case MOTOR_LEFT:
      return C_BITS_TO_16(TIM_GetCapture3(MOTORS_GPIO_TIM_M3_4));
    case MOTOR_REAR:
      return C_BITS_TO_16(TIM_GetCapture4(MOTORS_GPIO_TIM_M3_4));
    case MOTOR_RIGHT:
      return C_BITS_TO_16(TIM_GetCapture3(MOTORS_GPIO_TIM_M1_2));
    case MOTOR_FRONT:
      return C_BITS_TO_16(TIM_GetCapture4(MOTORS_GPIO_TIM_M1_2));
  }

  return -1;
}
Exemplo n.º 2
0
int motorsGetRatio(int id)
{
  switch(id)
  {
    case MOTOR_M1:
      return C_BITS_TO_16(MOTOR1_TIM->CCR4);
    case MOTOR_M2:
		return C_BITS_TO_16(MOTOR2_TIM->CCR4);
    case MOTOR_M3:
		return C_BITS_TO_16(MOTOR3_TIM->CCR4);
    case MOTOR_M4:
		return C_BITS_TO_16(MOTOR4_TIM->CCR3);
  }

  return -1;
}