#include "SPEED.h"
#include "can.h"
#include "math.h"
float pi_data = 3.141593;
float Radius = 0.270798;
float RPM = 0; //X = Est RPM(MCU CAN DATA)
float gear_ratio = 11.93;
float Est_Speed_data = 0;

void Est_Speed()
{
	RPM = GV_MCU_RPM;
	RPM = fabs(RPM);

    Est_Speed_data = 2*pi_data*Radius*(RPM / gear_ratio)* 60 / 1000;

    GV_VCU_Vx_Fbk = Est_Speed_data;



}