BiosKeyboardSetState(): TPL must be restore in error cases

Imported from edk2 r16556

Fix style too