The function h(•)that incorporates the observation vectorzk with the state vectorxkis given by สมการ
Where is the resultant pose of the UHL algorithm described in the previous section and δx UHL
Denotes the error associated to the observation vector zk.