MODBUS/UDP rw registers & bug fixes

- Fix for incorrect read indexing
- rw access check
- read & write register functionality

Signed-off-by: Olli Vanhoja <olli.vanhoja@gmail.com>