S-01040 Motion control, step 2: 1. added shared data holders; 2. implemented vertical motion control thread; 3. revised mutex implementation (moved inside the shared data holders); 4. refactored affected threads accordingly.