Updated SolvePnP (added x,y,z,r,p,y transformation), fixed CalcObjectLocation