How to do the math for a pose graph optimizer (slam)?

Question

Right now I\'m trying to implement a pose graph for a slam algorithm.
In order to this I\'ve seen some videos about it and found a example calculation which I now wanted t