1
$\begingroup$

I am trying to simulate and implement the controller in the paper Geometric Tracking Control of a Quadrotor UAV on SE(3). I have the dynamics implemented, however I am stuck at one part in the controller which is the calculation of the following equation:

$$e_\Omega=\Omega-R^TR_d\Omega_{d\cdot}$$

I have all the variables in equation (11) calculated except for $\Omega_d$ which is the desired angular velocity.

From equation (4) of the paper we know the relation:

$$\dot{R}_d=R_d\hat{\Omega}_d$$

However, I don't know how to calculate $\dot{R}_d$. Can someone give the exact equation for getting $\dot{R}_d$ so I can calculate $\Omega_d$ to get the error $e_\Omega$?

My code is available on github.

$\endgroup$
2
  • $\begingroup$ You know what $R_d$, the desired rotation matrix, is as a function of time? $\endgroup$
    – fibonatic
    Nov 22, 2017 at 8:45
  • $\begingroup$ Welcome to robotocs danny, great question. On Robotics we are fortunate enough to have MathJax support enabled, so I have updated your question to use it rather than use images for your equations. MathJax allows you to easily create subscripts, superscripts, fractions, square roots, greek letters and more. it also allows you to add both inline and block element mathematical expressions in robotics questions and answers. For a quick tutorial, take a look at How can I format mathematical expressions here, using MathJax? $\endgroup$
    – Mark Booth
    Nov 22, 2017 at 11:12

1 Answer 1

2
$\begingroup$

In this paper rotation matrices are used to describe the orientation of the quadrotor. This is chosen because each orientation as a single representation (contrary to quaternions) and gimbal lock is not possible (contrary to any Euler angle convention).

In the proposed controller, ones want to know how close the actual rotational velocities from the desired one, hence the equation (11) which provides this information as a vector from the matrix representation.

That being said, $\Omega_d$ is your desired angular velocity and should come from your planner as for the desired rotation transcribed in $R_d$. As you have the time evolution of $R_d$ you should be able to get its derivative $\dot{R}$.

$\endgroup$

Your Answer

By clicking “Post Your Answer”, you agree to our terms of service and acknowledge that you have read and understand our privacy policy and code of conduct.

Not the answer you're looking for? Browse other questions tagged or ask your own question.