|
Algorithm 1 Pseudocode of the VVS algorithm. |
| Initialize(); // get camera’s model parameters K and initial pose T |
|
; |
| 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; |
| ; // get the error between the current and desired feature |
| ) { |
| break; |
| } |
| else { |
| Calculate the interaction matrix L; |
| ; // get the virtual velocity |
| ; // update T |
| } |
| } |
|
; |