First and foremost, I would like to give my special thanks to Professor Seet Gim Lee, Gerald, my supervisor, for your generous support during all these years, for your mentoring, for the experienced guidance, academic supports, patience and valuable advices you have given during my research journey so far, especially for helping me find a way back at the time of being distracted from my research duty. I could not have imagined having a better advisor for my Ph.D study.I want to deeply grateful to Dr. Viatcheslav V Iastrebov for his enthusiastic cooperation and suggestions over the last 4 years when we implemented our project together. My work would have not been possible without your knowledge and experience. Furthermore, you are always a close friend to me and share many funny stories with me during my stay at RRC. I also would like to give big thanks to all my colleagues in Robotics Research Center: Wee Ching, Burhan, Hendra, Choon Yue, William, and Ahmad. You guys are always so nice to me since the first day I came to NTU. I especially wish to thank Ms. Wee Ching for sharing her knowledge and expertise at the beginning phase of my PhD project. I wish to show my great gratitude to my families. Without their unconditional supports and encouragements in moments of difficulties, I would not have been able to accomplish this result. Finally, I would love to specially thank my girlfriend, Ms.