Clarified some related works, added 2 references for sensor fusion.