# Quadrotor SE3 Controller: Calculating Rd_dot

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.

• You know what $R_d$, the desired rotation matrix, is as a function of time? Nov 22, 2017 at 8:45
• 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? Nov 22, 2017 at 11:12

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}$.