前回はexpmapを使った点に作用する姿勢の最適化を行ったが，今回は姿勢同士の作用に対する最適化について書いてみる．まずは簡単に現在の推定姿勢をとして，目標の姿勢に一致するように推定姿勢を更新してみる．