After allot of messing around with motors and firmwares i finally found the setup, PID tune and rates that I'm happy with.
Setup:
Vortex Pro
Lumenier 2206 2350KV Motors
Immersionrc Stage 1 Race Kit
HQ Tri 5x4x3
Tattu 1300mah 75c
Hero4 Black
Taranis
X4R
656g AUW ( With hero4 and battery )
Pids:
Pitch
P 6
I 0.040
D 34
Roll
P 4
I 0.040
D 34
Yaw
P 10.5
I 0.050
D 0