Program mecanum wheels

I think you will find good discussion and answer in these topics: