block_pid_aw.test.ctrl 1.58 KB
Newer Older
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
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
frequency 100

blocks {
	{ "pid_aw", "pid" }
	
	{ "test_input_float", "in"     }
	{ "test_input_bool",  "enable" }
	
	{ "test_output_float", "out"  }
	{ "test_output_float", "outp" }
	{ "test_output_float", "outi" }
	{ "test_output_float", "outd" }
}

links {
	{ "in", "value",     "pid", "in",     true }
	{ "enable", "value", "pid", "enable", true }
	{ "pid", "out",      "out", "value",  true }
	{ "pid", "outp",     "outp", "value", true }
	{ "pid", "outi",     "outi", "value", true }
	{ "pid", "outd",     "outd", "value", true }
}

params {
	{ "pid", "kp",   (float) 10.0 }
	{ "pid", "ki",   (float)  2.0 }
	{ "pid", "kd",   (float)  0.5 }
	{ "pid", "maxw", (float)  3.0 }
	{ "pid", "minw", (float) -0.01 }

	{ "enable", "value", 10,
	    (int) { false, true, true, true, true, true, true, true, true, false }
	}

	{ "in", "value", 10,
	    (float) { 0.0, 1.0, -1.0, -1.0, 10.0, 10.0, 100.0, 100.0, 10.0, 10.0 }
	}
	
	{ "out", "value", 10, 
	    (float) { 0.0, 60.02, -10.0, -10.0, 100.0, 100.0, 1000.0, 1000.0, 100.0, 0.0},
	    (float) { 0.0, 0.0, inf, inf, inf, inf, inf, inf, inf, 0.0}
	}

	{ "outp", "value", 10, 
	    (float) { 0.0, 10.0, -10.0, -10.0, 100.0, 100.0, 1000.0, 1000.0, 100.0, 0.0},
	    (float) { 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0}
	}

	{ "outi", "value", 10, 
	    (float) { 0.0, 0.02, 0.0, -0.01, 0.19, 0.39, 2.39, 3.0, 3.0, 0.0},
	    (float) { 0.0, 0.0,  0.0,  0.0,  1e-6, 1e-6, 1e-6, 0.0, 0.0, 0.0}
	}

	{ "outd", "value", 10, 
	    (float) { 0.0, 50.0, -100.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0},
	    (float) { 0.0, 0.0,     0.0, 0.0, inf, inf, inf, inf, inf, 0.0}
	}
}