Added write to serial port in calc_hw_testbench