modifiyed the algorithm to use two axis for data collection as well as throwing in a simple median filter. Documentation in progress