Δq ∈ [-0.05 … +0.05] rad for each arm joint (left arm by default). r = −5·‖Δp‖ – 0.1·‖Δq‖ + 1 when ‖Δp‖<2 cm −1 on self-collision –0.5 on limit hit.