Thanks guys, played with the curve and got is much better, it also helped that I found out I had my 3 position flight mode switch reversed so I was in full rate mode when I thought I was in Altitude mode....
Out of interest should I be able to arm in any of the modes? I only seem to be able to arm in stabilization 1 that is set to rate, rate, rate, If I swap the modes around I can't arm... No big deal I can arm in rate then spin up the motors and flip to altitude.