Got a pretty good fix working. Now working on extracting some useful depth information