Типа надо доделать протокол Modbus
Протокол доделывать не надо. Там уже все есть.
https://www.google.com/search?q=modbus+user+defined+function+code&oq=Modb us+user+&gs_lcrp=EgZjaHJvbWUqBwgBEAAYgAQyBggAEEUYO TIHCAEQABiABDIICAIQABgWGB4yCAgDEAAYFhgeMggIBBAAGBY YHjIICAUQABgWGB4yCAgGEAAYFhgeMggIBxAAGBYYHjIICAgQA BgWGB4yCAgJEAAYFhge0gEIOTY3MWowajeoAgCwAgA&sourcei d=chrome&ie=UTF-8