Help with holonomic

I have made a three wheel holonomic robot and have just finished the programming. One problem I have is that the robot does not go in a straight line but will arc. Over ten feet it will arc about 30 degrees off. Any help would be appreciated. I have attached the code bellow.
Code.zip (2.37 KB)