function d = oplus(a, b)
	c = cos(a(3)); s = sin(a(3));
	d = [ a(1) + c * b(1) - s  * b(2); ...
	      a(2) + s * b(1) + c  * b(2); ...
	      a(3) + b(3) ];