If sats > 7 then gps is working.
If the green then yellow light once in a while then you could be ATTI mode.
I think your right toggle switch has failed is on permanent ATTI.
Plug into Phantom assist or RC12 and test the S1 and S2 and make sure they are hitting 1000/0/-1000.
Lastly, go into the IMU screen and tilt your phantom in all axis and make sure all values are responding. If there is a value stuck, then you may need to tap the NAZA to remove the jam.