Parrot disco additonal servo configuration

Hi i am very new to modding in ardupilot

My aim is to put a FLIR camera on board a Parrot disco, we ran some trials using analog video link via another video audio / receiver … at certain angle the camera will be block by the body of the drones

so we put the FLIR camera on those cheap servo tilt and pan mounting, it works on adruino, we tested it with PWM controller, but we have no experience or any idea to code it and how to make the skycontroller 2 works with the servos

it is now connect to the CHUCK

  • channel 6 : servo rail pin 3
  • channel 7 : servo rail pin 4

help is much appreciated, this is for animal conservation

thank you in advance