Progress on test bench and fixing errors in controller.