Rethinked and revised this function. This previous one worked by "accident". More a sheer luck of offsets on current firmware (as of writing) But now, this is more mathematically correct way of creating a THUMB -> ARM BLX instruction. Also setting the new op in a set of 2 u16, because patching code is in thumb.