[ArucoThread] fix wrong problem with wrong marker vector and quat- add test if they have correct values.  Fix crash when camera.yml has wrong format.