Update lg_diag_testmode.c