Structure from Motion algorithm using 2 subsequent images