EULER_TO_MATRIX (190)


EULER_TO_MATRIX (190)

ID                          190

Zastosowanie:

PLC

SIM

 

Grupa: DATA CONVERSION

 

Opis skrótowy: 

Funkcja obliczająca elementy macierzy transformacji na podstawie kątów Eulera.

 

Wejścia (3 sztuki):

nr

typ

impuls

oznaczenie

uwagi

1

R

nie

rot_x

Pierwszy kąt Eulera - orientacja względem osi X
2 R nie rot_y Drugi kąt Eulera - orientacja względem osi Y
3 R nie rot_z Trzeci kąt Eulera - orientacja względem osi Z

 

Wyjścia (9 sztuk):

nr

typ

impuls

oznaczenie

uwagi

1

R

nie

PR11

Element [1,1] macierzy transformacji
2 R nie PR12 Element [1,2] macierzy transformacji
3 R nie PR13 Element [1,3] macierzy transformacji
4 R nie PR21 Element [2,1] macierzy transformacji
5 R nie PR22 Element [2,2] macierzy transformacji
6 R nie PR23 Element [2,3] macierzy transformacji
7 R nie PR31 Element [3,1] macierzy transformacji
8 R nie PR32 Element [3,2] macierzy transformacji
9 R nie PR33 Element [3,3] macierzy transformacji

 

ustawienia: brak

 

Działanie funkcji:

Funkcja EULER_TO_MATRIX oblicza elementy macierzy transformacji na podstawie kątów Eulera.

Macierz transformacji:

              [ PR11    PR12    PR13 ]
   Wyj =  [ PR21    PR22    PR23 ]
              [ PR31    PR32    PR33 ]          

Obliczenie elementów macierzy transformacji:

              [ c(Ry)*c(Rz)      -c(Rx)*s(Rz)+s(Ry)*s(Rx)*c(Rz)      c(Rx)*c(Rz)*s(Ry)+s(Rz)*s(Rx) ]
   Wyj =  [  s(Rz)*c(Ry)      c(Rz)*c(Rx)+s(Rx)*s(Ry)*s(Rz)      -c(Rz)*s(Rx)+c(Rx)*s(Rz)*s(Ry) ]
              [     -s(Ry)                             c(Ry)*s(Rx)                                c(Ry)*c(Rx)                    ]   

 

 

Używane rejestry R i znaczniki M: brak