Object Augmentation Algorithm: Computing virtual object motion and object induced interaction wrench from optical markers