INT16 - это знаковое целое. В терминологии Codesys -INT.
Преобразования INT_TO_WORD и WORD_TO_INT должны вам помочь.
формируете переменную в INT, преобразуете ее в WORD и записываете в выходной поток modbus.
Должно быть все нормально