[KWo]

Just look how splorygon did it in current beta sources of podbot mm (it works). Your problem might be related to screwed up one axis - there is a parameter for botaim2 - try to use it. The name is "botaim_fix". Try to use it as 1 or 0 - acording to this what You have already in code.