Figure 15:
Link 1 angular displacement with adaptive algorithm.