Added weighted averaging between pass 1 and pass 2 of the algorithm
Added weighted averaging between pass 1 and pass 2 of the algorithm

mbartling/TAMU_senior_design,mbartling/TAMU_senior_design,mbartling/TAMU_senior_design,mbartling/TAMU_senior_design,mbartling/TAMU_senior_design,mbartling/TAMU_senior_design,mbartling/TAMU_senior_design,mbartling/TAMU_senior_design