Add Equalization Function and update test.java