Added first version of motioncontrol by refactoring armarker detection as util use