[r2]: / ecu_at135_v2r1_baloo / StandardPLC / Plc Logic / Application / 011.Odométrie / Function_Speed_Sensor_MONOSIGNAL / svnobj  Maximize  Restore  History

Download this file

31 lines (29 with data), 4.5 kB 

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
FUNCTION_BLOCK Function_Speed_Sensor_MONOSIGNAL
VAR_INPUT
	Retour_Cycle_signal:		UDINT;	//  Information detection de mouvement en micro-sec - "Value Cycle" signal 
	Sensor_Resolution:			INT;	// Resolution du capteur
	Vitesse_moteur:				INT;
	Diametre_roue:				REAL;	// en millimetre
END_VAR
VAR_OUTPUT
	Vitesse_ms:					REAL;
	Vitesse_kmh:				REAL;
	Vitesse_revolution_par_min: REAL;
VAR
	revolution:					REAL;
	perimetre_roue:				REAL;
	vitesse_linaire:			REAL;
	Retour_cycle:				UDINT;
Retour_cycle := Retour_Cycle_signal;
IF ((Retour_cycle <> 0) AND (Vitesse_moteur <> 0)) THEN
	//
	revolution := (Value_freq_signal * 60);
	Vitesse_revolution_par_min := revolution / Sensor_Resolution;
	perimetre_roue := Diametre_roue * 3.14;
	
	Vitesse_ms := (perimetre_roue / 1000) * (Vitesse_revolution_par_min / 60);
	Vitesse_kmh := (Vitesse_ms * 3600 ) / 1000;
	ELSE
	Vitesse_ms := 0;
	Vitesse_kmh :=0;
	Vitesse_revolution_par_min := 0;
END_IF