mirror of
https://github.com/Dev-KATECH/ADM.git
synced 2026-05-17 01:43:59 +09:00
22 lines
369 B
C
22 lines
369 B
C
#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;
|
|
|
|
|
|
|
|
}
|