H-Bridge and Pic32 XBee code