Fixed bug and added CSP to TESTCTRL, fixed OTMB FIFO reset, CONTROL_FSM CSP