reorganize drive.c

all open loop code moved to drive_open_loop_dynamic_path.c
switch from plot_task to trace module
plot task use param for freq
Merge branch 'master' of github.com:froj/nastya