datapath Test bench

Added the datapath tesbench, fixed the datapath where necessary and took
screenshots of the successful simulation