Hola jaimelib postea lo que tengas hecho y seguro que encontras quien te ayude a resolver el problema, lo que no encontraras sera quien lo haga por ti.
De todos modos lo que pides no es muy dificil de hacer, todo seria comprobar el estado de los sensores que para ello hay dos instrucciones btfss o btfsc que pueden servirte y de acorde al que te este dando señal haces una cosa u otra.
Saludos!