Matrix.py
1 |
# -*- coding: utf-8 -*-
|
---|---|
2 |
"""
|
3 |
Created on Thu Apr 25 23:36:44 2017
|
4 |
System Matrices
|
5 |
University of Sao Paulo
|
6 |
@author: Gabriel
|
7 |
"""
|
8 |
|
9 |
def Matrix(p, x0,u0): |
10 |
|
11 |
from numpy import * |
12 |
|
13 |
A = array([[-p[0]/(p[1]*p[2]), -(p[0]-p[1])*u0[0]*sin(p[7])/(p[1]*p[2]), 0], |
14 |
[(p[0]-p[1])*u0[0]*sin(p[7])/(p[1]*p[2]*(p[6]**2)), -(p[0]-p[1])*u0[0]*cos(p[7])/(p[1]*p[2]*p[6]), 1], |
15 |
[-u0[0]*sin(p[7])/(p[3]*p[1]), -u0[0]*p[6]*cos(p[7])/(p[3]*p[1]), 0]]) |
16 |
B = array([[(p[0]-p[1])*cos(p[7])/(p[1]*p[2])], |
17 |
[-(p[0]-p[1])*sin(p[7])/(p[1]*p[2]*p[6])], |
18 |
[-p[6]*sin(p[7])/(p[1]*p[3])]]) |
19 |
C = array([[-u0[0]*sin(p[7])/p[1], -u0[0]*p[6]*cos(p[7])/p[1], 0], |
20 |
[-u0[0]*cos(p[7])/p[1], u0[0]*p[6]*sin(p[7])/p[1], 0]]) |
21 |
D = array([[2*p[4]*u0[0]-(p[6]*sin(p[7])/p[1])], |
22 |
[2*p[5]*u0[0]+(2*u0[0]-p[6]*cos(p[7]))/p[1]]]) |
23 |
|
24 |
return A, B, C, D
|