structure from motion python opencv