Added a testbench. Apparently vsim has a problem with shift opperators, I'll fix later