Was haben C.3 und C.4 für Aufgaben?
Verwendest du externe Pullups?
Was macht das Programm denn bis jetzt? Bzw. was genau geht nicht?

Warum If Portc.5 = .... ?

Ich hätte die DO LOOP Schleife anders ausgeführt.

Do
If Pinc.5 = 0 Then Gosub Zeile1 Else Gosub Zeile2
Loop