[lemiant]

Thanks guys. We managed to get it fixed at competition, big thanks to Simbotics. It appears it was a code problem. He coding mentor from Simbotics rewrote our drive code in java (it was C), and now it works fine.