Intrinsic Optimal Control for Mechanical Systems on Lie Group

Figure 1

Configuration error function values with different weights.