Chinook heli support in ArduPilot

I must say that the code I use will be slightly modified.
You can see my code here:

Detailed build of the heli being tested:

However, I’m dealing with a problem at the moment.
For more detail please see:

Any help will be appreciated. :slightly_smiling_face: