ciao a tutti

ho un problema con la programmazione del pic. ho creato questo programma perchè dovrei portarlo alla maturità solo che ho alcuni problemi e non riesco a capire quali siano questi problemi. il programma deve far muovere delle braccia robotiche che picchiano su uno xilofono e producono una sinfonia musicale.
ho creato una routine di avvio cioè ho fatto in modo che finchè la PORTB,6 non va a 1 il programma non parte. solo che quando lo provo nel debug per vedere se funziona devo togliere la routine di avvio e quando provo a farlo partire il programma fa quello che vuole e salta delle istruzioni e non riesco a capire il perchè, qualcuno mi può dare una mano?
grazie a tutti

questo è il programma:
robot.txt