MPLabX xc16 project for my Self Standing Robot