I am trying to get a pose (x,y,z + angles x,y,z). What is given (i is a discrete time t_i):
- pos_x(i), pos_z(i), pos_z(i)
- rot_x(i), rot_y(i), rot_z(i)
- a_x(i), a_y(i), a_z(i)
- a_rot_x(i), a_rot_y(i), a_rot_z(i)
- t_i+1 - t_i (delta)
What is needed:
- pos_x(i+1), pos_y(i+1), pos_z(i+1)
- rot_x(i+1), rot_y(i+1), rot_z(i+1)
I tried integrating that, but failed. Is there a formula for that or can You reference me somewhere.