You need to fix your "drunken flying" behaviour, before even attempting more advanced modes, such as autonomous flight modes with GPS. Adding GPS won't fix that magically, you need first to get copter flying well in Complementary (Basic) before attempting anything more advanced.