|
a |
|
b/Body/AAUHuman/Trunk/SRMatrixes.any |
|
|
1 |
OutDim = 18; |
|
|
2 |
|
|
|
3 |
// Coefficient matrix |
|
|
4 |
Coef = { |
|
|
5 |
{-1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 7.105616e-002, 0, 0}, |
|
|
6 |
{0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}, |
|
|
7 |
{0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 7.105616e-002}, |
|
|
8 |
|
|
|
9 |
{0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2.276759e-001, 0, 0}, |
|
|
10 |
{0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1.421123e-001, 0}, |
|
|
11 |
{0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2.276759e-001}, |
|
|
12 |
|
|
|
13 |
{0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 4.020500e-001, 0, 0}, |
|
|
14 |
{0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 3.132395e-001, 0}, |
|
|
15 |
{0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 4.020500e-001}, |
|
|
16 |
|
|
|
17 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 5.784718e-001, 0, 0}, |
|
|
18 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 4.908604e-001, 0}, |
|
|
19 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 0, 0, 0, 5.784718e-001}, |
|
|
20 |
|
|
|
21 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 7.462112e-001, 0, 0}, |
|
|
22 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 6.660833e-001, 0}, |
|
|
23 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 0, 0, 0, 7.462112e-001}, |
|
|
24 |
|
|
|
25 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 9.131695e-001, 0, 0}, |
|
|
26 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 8.263391e-001, 0}, |
|
|
27 |
{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -1, 0, 0, 9.131695e-001}}; |
|
|
28 |
|
|
|
29 |
// Constant vector |
|
|
30 |
Const = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; |