Add busy waiting mechanism
Test busy waiting
Update Aerotech motor for waiting mechanism