Tried to get the algorithm to work with 20 degree offset beams. Still need to tweak.