Skip to main content
. 2022 Dec 6;22(23):9545. doi: 10.3390/s22239545
Algorithm 1 Pseudocode of the VVS algorithm.
Initialize(); // get camera’s model parameters K and initial pose T
Get the desired features s*;
While (true) {
        Transform the model from object frame to camera frame by T;
        Project the model to image plane by K;
        Extract the feature s;
        ε=ss*; // get the error between the current and desired feature
        if (norm(ε)<threshold) {
                break;
        }
        else {
                Calculate the interaction matrix L;
                v=λL+ε; // get the virtual velocity
                T=Toc(k+1)=exp(v^)1ckTo; // update T
        }
}
T*=T;