[Alan Anderson]

You should show us the section of the program you're talking about. You should tell us what you expect it to do. You should tell us exactly what it is doing instead.

(And you should probably let us know what you mean when you say "this mplab", because I'm pretty sure most of us think MPLab is the program that we run on a Windows PC in order to write and compile programs for the robot.)