target: min: [0.1, 0.1, 0.0] max: [0.2, 0.2, 0.1] q0: [0.0, -0.79, 0.0, -2.356, 0.0, 1.57, 0.79]