updates to algorithm

Updated algorithm, and designed sensor output to now output a weighted
result based upon the active sensors.