I think that you can you try to flash the fmuv3 firmware on your Pixhawk to see if this solve the problem.