Haben sie auch diese Function in den rp6controllib.h gepackt ? Da muss ess auch declariert werden, aber nur die "heading". Die eigentliche function bleibt in controllib.