Quote:
Var 0000, Value 0 // INICIALIZA - Initialization
{
&ServoRB = 500 // Right Brake servo-motors to center
&ServoLB = 390 // Left Brake servo-motors to center
&ServoAP = 365 // ACCU Pressure servo-motors to center
}
Var 0001, name ServoRB, Link USB_SERVO, Device 10, Output 2, PosL 250, PosC 500, PosR 750, Type 1 // Right Brake
Var 0002, name ServoLB, Link USB_SERVO, Device 10, Output 3, PosL 700, PosC 390, PosR 270, Type 1 // Left Brake
Var 0003, name ServoAP, Link USB_SERVO, Device 10, Output 4, PosL 150, PosC 200, PosR 550, Type 1 // ACCU Pressur
Var 0010, name FSRightBrake, Link FSUIPC_IN, Offset $73A9, Length 1 // Right Brake 0-255
{
L0 = &FSRightBrake * 1.961 // Faktor: (750-250)/255
L1 = L0 + 250
IF L1 > 750 // Rechter Anschlag
{
L1 = 750
}
IF L1 < 250 // Linker Anschlag
{
L1 = 250
}
&ServoRB = L1
}
Var 0020, name FSLeftBrake, Link FSUIPC_IN, Offset $73A8, Length 1 // Left Brake 0-255
{
L0 = &FSLeftBrake * 1.686 // Faktor: (700-270)/255
L1 = 700 - L0
IF L1 < 270 // Rechter Anschlag
{
L1 = 270
}
IF L1 > 700 // Linker Anschlag
{
L1 = 700
}
&ServoLB = L1
}
Var 0030, name FSAccuPress, Link FSUIPC_IN, Offset $73A7, Length 1 // ACCU Pressure 0-255
{
L0 = &FSAccuPress * -1.568 // Faktor: (150-550)/255
L1 = L0 + 550
IF L1 > 550 // Rechter Anschlag
{
L1 = 550
}
IF L1 < 150 // Linker Anschlag
{
L1 = 150
}
&ServoAP = L1
}