Improved the linear system solved in global orientation

Change-Id: I1b6bafcfa2ad3791de7cabeb9ea0d7e54e1ed394