3wheelomni code for control of 3 wheel omni drive mobile bots with an angle of 120 degrees between the wheels