You didn't show what your $data contains, but you seem to be working with the hex representation of the data instead of working on the data represented. Don't convert your data to hex; that just complicates things.