ItoFP16
sqd = ItoFP16(dx * dx + dy * dy);
m = fp16_mul(m, ItoFP16(127));
m = fp16_div(m, ItoFP16(FOCI));
m = fp16_add(m, ItoFP16(127));