Simulation control diagrams on Simulink

I am trying to simulate the control diagrams on Simulink by transforming the controllers from C++ code to Simulink for making VTOL but I have some problems in MC Position Controllers so if anyone Have
done this before we can contact to solve my problem