https://123dok.net/document/zlglp446-camera-parameter-initialization-for-d-kinematic-systems.html