使用 HTC Vive 的 Lighthouse 系统和 Teensy 板的 位置跟踪传感器的代码和示意图 C++

# DIY Position Tracking using HTC Vive's Lighthouse [](https://travis-ci.org/ashtuchkin/vive-diy-position-sensor) * General purpose indoor positioning sensor, good for robots, drones, etc. * 3d position accuracy: currently ~10mm; less than 2mm possible with additional work. * Update frequency: 30 Hz * Output formats: Text; Mavlink ATT_POS_MOCAP via serial; Ublox GPS emulation (in works) * HTC Vive Station visibility requirements: full top hemisphere from sensor. Both stations need to be visible. * Positioning volume: same as HTC Vive, approx up to 4x4x3 meters. * Cost: ~$10 + [Teensy 3.2 ($20)](https://www.pjrc.com/store/teensy32.html) (+ [Lighthouse stations (2x $135)](http://www.vive.com/us/accessory/base-station/)) * Skills to build: Low complexity soldering; Embedded C++ recommended for integration to your project. * License: MIT |  |  | | --- | --- | | Demo showing raw XYZ position: [](https://www.youtube.com/watch?v=Xzuns5UYP8M) | Indoor hold position for a drone: [](https://www.youtube.com/watch?v=7GgB5qnx6_s) | ## How it works Lighthouse position tracking system consists of:   – two stationary infrared-emitting base stations (we'll use existing HTC Vive setup),   – IR receiving sensor and processing module (this is what we'll create). The base stations are usually placed high in the room corners and "overlook" the room. Each station has an IR LED array and two rotating laser planes, horizontal and vertical. Each cycle, after LED array flash (sync pulse), laser planes sweep the room horizontally/vertically with constant rotation speed. This means that the time between the sync pulse and the laser plane "touching" sensor is proportional to horizontal/vertical angle from base station's center direction. Using this timing information, we can calculate 3d lines from each base station to sensor, the crossing of which yields 3d coordinates of our sensor (see [calculation details](../../wiki/Position-calculation-in-detail)). Great thing about this approach is that it doesn't depend on light intensity and can be made very precise with cheap hardware. Visualization of one base station (by rvdm88, click for full video): [](https://www.youtube.com/watch?v=oqPaaMR4kY4) See also: [This Is How Valve’s Amazing Lighthouse Tracking Technology Works – Gizmodo](http://gizmodo.com/this-is-how-valve-s-amazing-lighthouse-tracking-technol-1705356768) [Lighthouse tracking examined – Oliver Kreylos' blog](http://doc-ok.org/?p=1478) [Reddit thread on Lighthouse](https://www.reddit.com/r/Vive/comments/40877n/vive_lighthouse_explained/) The sensor we're building is the receiving side of the Lighthouse. It will receive, recognize the IR pulses, calculate the angles and produce 3d coordinates. ## How it works – details Base stations are synchronized and work in tandem (they see each other's pulses). Each cycle only one laser plane sweeps the room, so we fully update 3d position every 4 cycles (2 stations * horizontal/vertical sweep). Cycles are 8.333ms long, which is exactly 120Hz. Laser plane rotation speed is exactly 180deg per cycle. Each cycle, as received by sensor, has the following pulse structure: | Pulse start, µs | Pulse length, µs | Source station | Meaning | | --------: | ---------: | -------------: | :------ | | 0 | 65–135 | A | Sync pulse (LED array, omnidirectional) | | 400 | 65-135 | B | Sync pulse (LED array, omnidirectional) | | 1222–6777 | ~10 | A or B | Laser plane sweep pulse (center=4000µs) | | 8333 | | | End of cycle | You can see all three pulses in the IR photodiode output (click for video): [](https://youtu.be/7OFeN3gl3SQ) The sync pulse lengths encode which of the 4 cycles we're receiving and station id/calibration data (see [description](https://github.com/nairol/LighthouseRedox/blob/master/docs/Light%20Emissions.md)). ## Hardware Complete tracking module consists of two parts: * IR Sensor and amplifier (custom board) * Timing & processing module (we use Teensy 3.2) ### IR Sensor To detect the infrared pulses, of course we need an IR sensor. After a couple of attempts, I ended up using [BPV22NF](http://www.vishay.com/docs/81509/bpv22nf.pdf) photodiodes. Main reasons are: * Optical IR filter 790-1050nm, which excludes most of sunlight, but includes the 850nm stations use. * High sensitivity and speed * Wide 120 degree field of view To get the whole top hemisphere FOV we need to place 3 photodiodes in 120deg formation in horizontal plane, then tilt each one 30deg in vertical plane. I used a small 3d-printed part, but it's not required.   ### Sensor board IR photodiodes produce very small current, so we need to amplify it before feeding to a processing module. I use [TLV2462IP](https://store.ti.com/TLV2462IP.aspx) opamp – a modern, general purpose rail-to-rail opamp with good bandwidth, plus there are 2 of them in a chip, which is convenient. One more thing we need to add is a simple high-pass filter to filter out background illumination level changes. Full schematics:  | Top view | Bottom view | | --- | --- | |  |  | Part list (add to cart [from here](1-click-bom.tsv) using [1-click BOM](https://1clickbom.com)): | Part | Model | Count | Cost (digikey) | | --- | --- | --- | ---: | | D1, D2, D3 | BPV22NF | 3 | 3x[$1.11](https://www.digikey.com/product-detail/en/vishay-semiconductor-opto-division/BPV22NF/751-1007-ND/1681141) | | U1, U2 | TLV2462IP | 1 | [$2.80](https://www.digikey.com/product-detail/en/texas-instruments/TLV2462IP/296-1893-5-ND/277538) | | Board | Perma-proto | 1 | [$2.95](https://www.digikey.com/product-detail/en/adafruit-industries-llc/1608/1528-1101-ND/5154676) | | C1 | 5pF | 1 | [$0.28](https://www.digikey.com/product-detail/en/tdk-corporation/FG28C0G1H050CNT06/445-173467-1-ND/5812072) | | C2 | 10nF | 1 | [$0.40](https://www.digikey.com/product-detail/en/tdk-corporation/FK24C0G1H103J/445-4750-ND/2050099) | | R1 | 100k | 1 | [$0.10](https://www.digikey.com/product-detail/en/stackpole-electronics-inc/CF14JT100K/CF14JT100KCT-ND/1830399) | | R2, R4 | 47k | 2 | 2x[$0.10](https://www.digikey.com/product-detail/en/stackpole-electronics-inc/CF14JT47K0/CF14JT47K0CT-ND/1830391) | | R3 | 3k | 1 | [$0.10](https://www.digikey.com/product-detail/en/stackpole-electronics-inc/CF12JT3K00/CF12JT3K00CT-ND/1830498) | | Total | | | $10.16 | Sample oscilloscope videos: | Point | Video | | --- | --- | | After transimpedance amplifier: we've got a good signal, but notice how base level changes depending on background illumination (click for video) | [![first point](https://cloud.githubusercontent.com/assets/627997/20243649/83a717b2-a915-11e6-84d1