Added three dimensional position sensor

Includes visualization code