I would suggest googling for c++ swerve code and using that as a basis for your LabView code. The math will be the same.
I'd also suggest that in the future you limit experimentation with new drivetrain systems to the off season. It's a pretty hard thing to perfect during the build season.
Here is a fairly extensive analysis of swerve kinematics:
https://www.chiefdelphi.com/media/papers/2426