I am trying to implement GraphSlam from this paper. I have some doubt regarding the algorithm described in this paper at table2: Algorithm GraphSLAM_linearize.
I have a doubt in line 7. As per my knowledge, Gt is a 3*3 matrix. How could I subtract 1 from a 3*3 matrix? As per matrix subtraction rule both matrices should be in same dimension.