Removed some redundant code. Added extraction of initial ar marker for demo + how it is used in do_task.py. Not yet tested.