Fixed control to support bltz and bgez. Fixed datapth to support shifts correctly.