Peak Detection and Accumulation Working

Peak detection working. New testbenches and fixed code.