MC100/Applications/foc/core/circle_limitation.c

#include "circle_limitation.h"

void circle_limitation(dq_t *inout_vdq, float in_vbus, float svm_ration){
	float svd = SQ(inout_vdq->Vd);
	float svq = SQ(inout_vdq->Vq);
	float svBus = SQ(in_vbus*svm_ration);
	if (svd + svq > svBus) {
		float r = sqrtf(svBus/(svd+svq));
		inout_vdq->Vd *= r;
		inout_vdq->Vq *= r;
	}
}