- #1
azizz
- 38
- 0
For a kinematic problem I obtained the following equations:
p1=- r*sin(theta_c) - d*cos(psi_a)*sin(theta_a)+c1
p2=d*sin(psi_a)*sin(theta_a)+c2
p3=d*cos(theta_a) + r*cos(theta_c)+c3
I want to solve these equations for theta_a, psi_a, theta_c, assuming that all other variables are known.
The solutions should be within these constraints:
-pi/4<psi_a<pi/4
pi/4<theta_a<3*4/pi
-pi/2<theta_c<pi/2
Can someone help me solving this problem? I think it should be possible, but it is quite hard...
Thx in advance
p1=- r*sin(theta_c) - d*cos(psi_a)*sin(theta_a)+c1
p2=d*sin(psi_a)*sin(theta_a)+c2
p3=d*cos(theta_a) + r*cos(theta_c)+c3
I want to solve these equations for theta_a, psi_a, theta_c, assuming that all other variables are known.
The solutions should be within these constraints:
-pi/4<psi_a<pi/4
pi/4<theta_a<3*4/pi
-pi/2<theta_c<pi/2
Can someone help me solving this problem? I think it should be possible, but it is quite hard...
Thx in advance