Okay, tried it wouthout the gps, without any calibration it's much better, it now goes forward after takeoff, but I think that's just because I did not recalibrate the things.
Is it possible that my gps causes all my problems? It's a UbloxNeo-6M, it was packed with the revo.