How to simulate 6 equations in a 3D space/Envi​ronment/Tr​jectory plane?

Hi everyone,

I was working on modelling and controlling a quad rotor flying robot. And finally I am done with the whole process. However, lately I thought of simulating the robot in a 3D trajectory plane or may be an environment to track it's path and see the differences UN-controlled and after controlling. I don't wanna write lots of complex mathematical equation to describe what I wanna do in order to make it easy for anyone to help me.

My question is simple as follows: I have 6 equations that give 6 different outputs (X Y Z theta Phi Epsi). All what I need from anyone is tell me how to connect 6 different equation with 1 block diagram that translates these outputs in a 3D space.

Regards,

Zack

[Heba El Kholy]

Hello Zack,

I am wondering if you reached a solution for your problem as I am working on the same project as well and I am done with the model and the PD Controller and I wanted to plot my results on a 3D environment.

I would appreciate your feedback,

Best Regards,

Heba

Answer 1

[iyad salameh]

Hi Zack , in MATLAB Library there is SimScape which includes SimMechanics , it has many useful blocks. Also there is the Aerospace Blockset where you will find output animation for planes ... and a menu called "Axes Transformation" for rotational and translation matrices .

by the way .. am also working on simulation on MATLAB for Quadroto(Quadcopter), for my project in mechatronics and would like to share ideas if u are open to that :)

regards Iyad.