TKOFF mode vs Mission Takeoff regarding altitude

Using mission takeoff my plane starts fine, reaches required altitude with no problems.
Using Tkoff mode it goes up to 20m and then levels.

Any ideas?

Newest 4.1 stable.

Try checking TKOFF_ALT in your parameters. When using mission takeoff it will use the target altitude as you set in the planning tab, when using TKOFF mode it will use the TKOFF_ parameters instead.

I think I got it sorted.
I had tkoff lvl altitude set to 20m so for the first 20m it would climb nicely but then it would level and start circling and climbing over the tkoff distance.
I set it to 30m now so for the first 30m it climbs straight up, then levels a bit and starts climbing in a circle until it reaches the tkoff altitude.