Figure 23:
Link 2 angular displacement with adaptive algorithm.