Copter: add zero slope checks to wpinav

also added RTL fix to set wpinav target explicitly