b = [0x14, r, 0, r2] should be b = [0x15, r, 0, r2] otherwise the *.bin will use STL op code for either STL or STH.