Pegasus servos RS485 bus

Hi,

I am currently using Pegasus actuators on my UAV. I use actuators with pwm input, but I would like to use servos with RS485. How can this function be implemented in ardupilot?
By extending it with RS485, I could get complete diagnostics from the servo.

Am I able to implement this feature to the autopilot by myself?

Thank you