[tst1.py] Added function to write 16bit register