Mal unabhängig davon das die Struktur des Programms nicht sooo gut funktionieren wird, kannst Du auch anstelle von
task_motionControl, task_ACS und task_ADC auch einfach


task_RP6System();


aufrufen - ist wohl einfacher und man kann nichts wichtiges mehr vergessen

MfG,
SlyD