Dual Time-of-Flight Depth Sensing

[lolzballs]

We need to figure out how to interface with the two ToF sensors. One thing of note is we need to program the I2C addresses so that we can access both on one bus.

Additionally we need to characterize the error and measure the performance of these sensors.

We also need the algorithm to determine the door angle from the output of the two sensors, and how the arm should perform searching.

Datasheet

[lolzballs]

I'll begin work on this tomorrow.

[lolzballs]

In a866ef6 significant progress has been made, where XSHUT can be properly controlled to allow usage of two ToF sensors on one I2C bus.

[JonEsparaz]

@lolzballs can we close this issue? This works now if I recall correctly?

[lolzballs]

Still needs to be integrated into Python.