all ok now.
Next step is to control more quads or increase speed.
Merge branch 'JX' of https://github.com/zhao0079/Simulink-for-Quadcopter into JX
Merge branch 'JX' of https://github.com/zhao0079/Simulink-for-Quadcopter into JX
tested hover in debug mode. works perfectly.