APM testing

Is there a test routine that I can run on my APM to see if it’s working correctly ?

Having some issues with RTL and when things go bad and it hits the fence and RTL kicks in then things go really bad…

Almost destroyed it about the third time I flew it…