Implement new modbus register functions