Added parser intrinsic paramenter. added set type robot. General Improvments