#include "foc/core/torque.h"
#include "foc/foc_config.h"
/*
通过查表获取对应扭矩和速度时的Id和IQ的分配
*/
void torque_init(void) {

}

void torque_get_idq(float torque, float rpm, DQ_t *dq_out) {
	dq_out->d = 0;
	dq_out->q = torque;
}

float speed_target_from_throttle(float f_throttle) {

	if (f_throttle <= (THROTTLE_LOW_VALUE)) {
		return 0;
	}
	float delta = f_throttle - (THROTTLE_LOW_VALUE);

	float ration = delta / (THROTTLE_MAX_VALUE - THROTTLE_LOW_VALUE);

	return (PMSM_FOC_GetSpeedLimit() * ration);
}

float torque_target_from_throttle(float f_throttle) {
	if (f_throttle <= (THROTTLE_LOW_VALUE)) {
		return 0;
	}
	float delta = f_throttle - (THROTTLE_LOW_VALUE);

	float ration = delta / (THROTTLE_MAX_VALUE - THROTTLE_LOW_VALUE);

	return (PMSM_FOC_GetTorqueLimit() * ration);
}