TVZ2019 / Mbed 2 deprecated MODBUS_TCP-IP

Aplikacijski kod

Dependencies:   mbed

U prikazanom primjeru izvedena je remote ModBus TCP/IP komunikacija. Generalni opis konfiguracije: U ovom radu je korištena oprema prizvođača Mikortik te mikrokontroler mbed NXP LPC1768. Libery za ethernet odnosno Modbus TCP/IP sam skino sam stranice mbeda te sam ga modificirao kako bi odgovarao željenoj aplikaciji. (https://os.mbed.com/users/paleskyjp/code/ModbusTCP_Modified/) Preko mrežne opreme izeveo sam SSTP VPN koji spaja lokalne subnete iz uređaja "mbed LOCAL" i uređaja "mbed LAPTOP" u jedan jedinstveni te omogućava nesmetanu komunikaciju između uređaja povezanih u lokalnim subnetima. Moguće se također spojiti direktno preko ethernet kabela u uređaj, ali u ovom primjeru laptop je spojen na WIFI mrežu nazvanzu "MBED TVZ" te preko nje komunicira sa mikrokontrolerom koji je kabelom spojem u mrežni uređaj naziva "mbed LOCAL". Riječ remote u ovom primjeru pokazuje da su dva uređaja "mbed LOCAL" i "mbed LAPTOP" preko WIFI-ja spojeni na 2 različita hosta (mobiteli pored njih) te je otvoren VPN kanal između njih. Na uređajima je također podešen DHCP koji dodijeljuje adrese uređajima koji se pokušavaju spojiti na njih, tako i mikrokontroleru. Lokalni subnet nije pušten na internet te mbed nije direktno izložen internetu, što pridonosi sigurnosnom aspektu komunikacije. Za tesitranje komunikacije dovoljno je koristit osnovne alate koji dolaze sa svakim windows-ima, naredba ping (na videu doljnji desni dio ekrana, dok je mbed bio ugašen vidljivo je da ne prolazi komunikacija, nakon što se upalio i spojio na mrežu komunikacija se uspostavila te je vidljivo kako konstantno vraća odgovor) Alat korišten za upis podataka u registre je Modbus Master koji podržava TCP/IP. Svakako je moguće koristiti i druge aplikacije ili druge uređaje koji podržavaju ovaj tip komunikacije. Primjerice PLC, drugi mbed, neko drugo računalo,... Aplikacija sama po sebi nije nešto pretjerano komplicirana ali put samog paketa od Modbus master-a do samog Modbus slave-a nije tako jednostavan. Aplikacija se odnosi na dio ukoliko na nulti registar bilo koje adresnog polja Modbus master pošalje vrijednost veću od 5 konstantno svijetli LED2 izvedena na samoj ploćici mbeda, te ukoliko dođe vrijednos manja od 5 da ugasi LED2. To je samo demostracija rada komunikacije. U ovoj konfiguraciji moguće je bilo gdje odnjeti mikortik i mbed te ga spojiti na WIFI koji ima propust prema internetu te se sa drugim mikrotikom povezati sa mbed-om i nesmetano komunicirati.

main.cpp@4:97b3bd92b315, 2019-11-14 (annotated)

Committer:
lincina
Date:
Thu Nov 14 15:38:42 2019 +0000
Revision:
4:97b3bd92b315
Parent:
3:d7d7c67f21fa 
remote komunikacija

Who changed what in which revision?

UserRevisionLine numberNew contents of line
paleskyjp 0:62be54b8975d 1 /*
paleskyjp 0:62be54b8975d 2 * FreeModbus Libary: BARE Demo Application
paleskyjp 0:62be54b8975d 3 * Copyright (C) 2006 Christian Walter <wolti@sil.at>
paleskyjp 0:62be54b8975d 4 *
paleskyjp 0:62be54b8975d 5 * This program is free software; you can redistribute it and/or modify
paleskyjp 0:62be54b8975d 6 * it under the terms of the GNU General Public License as published by
paleskyjp 0:62be54b8975d 7 * the Free Software Foundation; either version 2 of the License, or
paleskyjp 0:62be54b8975d 8 * (at your option) any later version.
paleskyjp 0:62be54b8975d 9 *
paleskyjp 0:62be54b8975d 10 * This program is distributed in the hope that it will be useful,
paleskyjp 0:62be54b8975d 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
paleskyjp 0:62be54b8975d 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
paleskyjp 0:62be54b8975d 13 * GNU General Public License for more details.
paleskyjp 0:62be54b8975d 14 *
paleskyjp 0:62be54b8975d 15 * You should have received a copy of the GNU General Public License
paleskyjp 0:62be54b8975d 16 * along with this program; if not, write to the Free Software
paleskyjp 0:62be54b8975d 17 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
paleskyjp 0:62be54b8975d 18 *
paleskyjp 0:62be54b8975d 19 * File: $Id: demo.c,v 1.1 2006/08/22 21:35:13 wolti Exp $
paleskyjp 0:62be54b8975d 20
paleskyjp 0:62be54b8975d 21 * modified from: Thanassis Mavrogeorgiadis 5-12-2011
paleskyjp 0:62be54b8975d 22 */
paleskyjp 0:62be54b8975d 23
paleskyjp 0:62be54b8975d 24 #include "mbed.h"
paleskyjp 0:62be54b8975d 25
paleskyjp 0:62be54b8975d 26 /* ----------------------- Modbus includes ----------------------------------*/
paleskyjp 0:62be54b8975d 27 #include "mb.h"
paleskyjp 0:62be54b8975d 28 #include "mbport.h"
paleskyjp 0:62be54b8975d 29 #include "mbconfig.h"
paleskyjp 0:62be54b8975d 30
paleskyjp 0:62be54b8975d 31
paleskyjp 0:62be54b8975d 32 #if MB_TCP_ENABLED == 1
paleskyjp 0:62be54b8975d 33 #include "EthernetNetIf.h"
paleskyjp 0:62be54b8975d 34 EthernetNetIf eth;
paleskyjp 0:62be54b8975d 35 #endif
paleskyjp 0:62be54b8975d 36
paleskyjp 0:62be54b8975d 37 extern Serial pc;
paleskyjp 0:62be54b8975d 38
paleskyjp 0:62be54b8975d 39 DigitalOut led1(LED1);
paleskyjp 0:62be54b8975d 40
paleskyjp 0:62be54b8975d 41 DigitalIn ENET_LINK(P1_25);
paleskyjp 0:62be54b8975d 42 DigitalOut LedLINK(LED4);
paleskyjp 0:62be54b8975d 43 Ticker EtherPinMonitor;
paleskyjp 0:62be54b8975d 44
paleskyjp 0:62be54b8975d 45 #if MB_TCP_ENABLED == 1
paleskyjp 0:62be54b8975d 46 void EtherPinMonitorFunc(void)
paleskyjp 0:62be54b8975d 47 {
paleskyjp 0:62be54b8975d 48 LedLINK = !ENET_LINK;
paleskyjp 0:62be54b8975d 49 }
paleskyjp 0:62be54b8975d 50 #endif
paleskyjp 0:62be54b8975d 51
paleskyjp 0:62be54b8975d 52 /* ----------------------- Defines ------------------------------------------*/
paleskyjp 0:62be54b8975d 53 #define REG_INPUT_START 1001
paleskyjp 0:62be54b8975d 54 #define REG_INPUT_NREGS 4
paleskyjp 0:62be54b8975d 55
paleskyjp 0:62be54b8975d 56 #define REG_HOLDING_START 2001
paleskyjp 0:62be54b8975d 57 #define REG_HOLDING_NREGS 130
paleskyjp 0:62be54b8975d 58
paleskyjp 0:62be54b8975d 59 #define REG_COIL_START (3000+1)
paleskyjp 0:62be54b8975d 60 #define REG_COIL_NREGS 8
paleskyjp 0:62be54b8975d 61 #define REG_COIL_BYTES REG_COIL_NREGS/8
paleskyjp 0:62be54b8975d 62
paleskyjp 0:62be54b8975d 63 #define REG_DISC_START (4000+1)
paleskyjp 0:62be54b8975d 64 #define REG_DISC_NREGS 8
paleskyjp 0:62be54b8975d 65 #define REG_DISC_BYTES REG_DISC_NREGS/8
paleskyjp 0:62be54b8975d 66
paleskyjp 0:62be54b8975d 67 #define SLAVE_ID 0x0A
paleskyjp 0:62be54b8975d 68
paleskyjp 0:62be54b8975d 69 /* ----------------------- Static variables ---------------------------------*/
paleskyjp 0:62be54b8975d 70 static USHORT usRegInputStart = REG_INPUT_START;
paleskyjp 0:62be54b8975d 71 static USHORT usRegInputBuf[REG_INPUT_NREGS];
paleskyjp 0:62be54b8975d 72 static USHORT usRegHoldingStart = REG_HOLDING_START;
paleskyjp 0:62be54b8975d 73 static USHORT usRegHoldingBuf[REG_HOLDING_NREGS]={0x0123,0x4567,0x89AB,0xCDEF,0xDEAD,0xBEEF,0xDEAD,0xBEEF,0xDEAD,0xBEEF};
paleskyjp 0:62be54b8975d 74 static USHORT usRegCoilStart = REG_COIL_START;
paleskyjp 0:62be54b8975d 75 static UCHAR usRegCoilBuf[REG_COIL_BYTES]={0xA5};
paleskyjp 0:62be54b8975d 76 static USHORT usRegDiscStart = REG_DISC_START;
paleskyjp 0:62be54b8975d 77 static UCHAR usRegDiscBuf[REG_DISC_BYTES]={0x5A};
paleskyjp 0:62be54b8975d 78
paleskyjp 0:62be54b8975d 79 /* ----------------------- Start implementation -----------------------------*/
paleskyjp 0:62be54b8975d 80
paleskyjp 0:62be54b8975d 81
paleskyjp 0:62be54b8975d 82 int main() {
paleskyjp 0:62be54b8975d 83 eMBErrorCode eStatus;
lincina 4:97b3bd92b315 84
lincina 4:97b3bd92b315 85 printf("Ekipa book :) ");
paleskyjp 0:62be54b8975d 86 #if MB_TCP_ENABLED == 1
paleskyjp 0:62be54b8975d 87 pc.baud(115200);
paleskyjp 0:62be54b8975d 88 EtherPinMonitor.attach(&EtherPinMonitorFunc, 0.01);
paleskyjp 0:62be54b8975d 89 printf("Setting up...\n");
paleskyjp 0:62be54b8975d 90 EthernetErr ethErr = eth.setup();
paleskyjp 0:62be54b8975d 91 if(ethErr)
paleskyjp 0:62be54b8975d 92 {
paleskyjp 0:62be54b8975d 93 printf("Error %d in setup.\n", ethErr);
paleskyjp 0:62be54b8975d 94 return -1;
paleskyjp 0:62be54b8975d 95 }
paleskyjp 0:62be54b8975d 96 printf("Setup OK\n");
paleskyjp 0:62be54b8975d 97 IpAddr ip = eth.getIp();
paleskyjp 0:62be54b8975d 98 printf("mbed IP Address is %d.%d.%d.%d\r\n", ip[0], ip[1], ip[2], ip[3]);
paleskyjp 0:62be54b8975d 99 #endif
lincina 4:97b3bd92b315 100
paleskyjp 0:62be54b8975d 101 Timer tm;
paleskyjp 0:62be54b8975d 102 tm.start();
paleskyjp 0:62be54b8975d 103
paleskyjp 0:62be54b8975d 104 #if MB_RTU_ENABLED == 1
paleskyjp 0:62be54b8975d 105 eStatus = eMBInit( MB_RTU, SLAVE_ID, 0, 9600, MB_PAR_NONE );
paleskyjp 0:62be54b8975d 106 #endif
paleskyjp 0:62be54b8975d 107 #if MB_ASCII_ENABLED == 1
paleskyjp 0:62be54b8975d 108 eStatus = eMBInit( MB_ASCII, SLAVE_ID, 0, 9600, MB_PAR_NONE );
paleskyjp 0:62be54b8975d 109 #endif
paleskyjp 0:62be54b8975d 110 #if MB_TCP_ENABLED == 1
paleskyjp 0:62be54b8975d 111 eStatus = eMBTCPInit( MB_TCP_PORT_USE_DEFAULT );
paleskyjp 0:62be54b8975d 112 #endif
paleskyjp 0:62be54b8975d 113 if (eStatus != MB_ENOERR )
paleskyjp 0:62be54b8975d 114 printf( "can't initialize modbus stack!\r\n" );
paleskyjp 0:62be54b8975d 115
paleskyjp 0:62be54b8975d 116 /* Enable the Modbus Protocol Stack. */
paleskyjp 0:62be54b8975d 117 eStatus = eMBEnable( );
paleskyjp 0:62be54b8975d 118 if (eStatus != MB_ENOERR )
paleskyjp 0:62be54b8975d 119 fprintf( stderr, "can't enable modbus stack!\r\n" );
paleskyjp 0:62be54b8975d 120
paleskyjp 0:62be54b8975d 121 // Initialise some registers
paleskyjp 0:62be54b8975d 122 usRegInputBuf[1] = 0x1234;
paleskyjp 0:62be54b8975d 123 usRegInputBuf[2] = 0x5678;
paleskyjp 0:62be54b8975d 124 usRegInputBuf[3] = 0x9abc;
paleskyjp 0:62be54b8975d 125
paleskyjp 0:62be54b8975d 126 while(true)
paleskyjp 0:62be54b8975d 127 {
paleskyjp 0:62be54b8975d 128 #if MB_TCP_ENABLED == 1
paleskyjp 0:62be54b8975d 129 Net::poll();
paleskyjp 0:62be54b8975d 130 #endif
lincina 4:97b3bd92b315 131 if(tm.read()>1.5)
paleskyjp 0:62be54b8975d 132 {
paleskyjp 0:62be54b8975d 133 led1=!led1; //Show that we are alive
paleskyjp 0:62be54b8975d 134 tm.start();
lincina 4:97b3bd92b315 135 //printf ("|R0| %d||",usRegInputBuf[1]);
lincina 4:97b3bd92b315 136 // printf ("|R1| %d||",usRegHoldingBuf[1]);
paleskyjp 0:62be54b8975d 137 }
lincina 4:97b3bd92b315 138
paleskyjp 3:d7d7c67f21fa 139
paleskyjp 0:62be54b8975d 140 eStatus = eMBPoll( );
paleskyjp 0:62be54b8975d 141
paleskyjp 0:62be54b8975d 142 /* Here we simply count the number of poll cycles. */
paleskyjp 0:62be54b8975d 143 usRegInputBuf[0]++;
paleskyjp 0:62be54b8975d 144 }
paleskyjp 0:62be54b8975d 145 //return 0;
paleskyjp 0:62be54b8975d 146 }
paleskyjp 0:62be54b8975d 147
paleskyjp 0:62be54b8975d 148 eMBErrorCode
paleskyjp 0:62be54b8975d 149 eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
paleskyjp 0:62be54b8975d 150 {
paleskyjp 0:62be54b8975d 151 eMBErrorCode eStatus = MB_ENOERR;
paleskyjp 0:62be54b8975d 152 int iRegIndex;
paleskyjp 0:62be54b8975d 153
paleskyjp 0:62be54b8975d 154 if( ( usAddress >= REG_INPUT_START )
paleskyjp 0:62be54b8975d 155 && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
paleskyjp 0:62be54b8975d 156 {
paleskyjp 0:62be54b8975d 157 iRegIndex = ( int )( usAddress - usRegInputStart );
paleskyjp 0:62be54b8975d 158 while( usNRegs > 0 )
paleskyjp 0:62be54b8975d 159 {
paleskyjp 0:62be54b8975d 160 *pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] >> 8 );
paleskyjp 0:62be54b8975d 161 *pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] & 0xFF );
paleskyjp 0:62be54b8975d 162 iRegIndex++;
paleskyjp 0:62be54b8975d 163 usNRegs--;
paleskyjp 0:62be54b8975d 164 }
paleskyjp 0:62be54b8975d 165 }
paleskyjp 0:62be54b8975d 166 else
paleskyjp 0:62be54b8975d 167 {
paleskyjp 0:62be54b8975d 168 eStatus = MB_ENOREG;
paleskyjp 0:62be54b8975d 169 }
paleskyjp 0:62be54b8975d 170 return eStatus;
paleskyjp 0:62be54b8975d 171 }
paleskyjp 0:62be54b8975d 172
paleskyjp 0:62be54b8975d 173 eMBErrorCode
paleskyjp 0:62be54b8975d 174 eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )
paleskyjp 0:62be54b8975d 175 {
paleskyjp 0:62be54b8975d 176 eMBErrorCode eStatus = MB_ENOERR;
paleskyjp 0:62be54b8975d 177 int iRegIndex;
paleskyjp 0:62be54b8975d 178
paleskyjp 0:62be54b8975d 179 if( ( usAddress >= REG_HOLDING_START ) &&
paleskyjp 0:62be54b8975d 180 ( usAddress + usNRegs <= REG_HOLDING_START + REG_HOLDING_NREGS ) )
paleskyjp 0:62be54b8975d 181 {
paleskyjp 0:62be54b8975d 182 iRegIndex = ( int )( usAddress - usRegHoldingStart );
paleskyjp 0:62be54b8975d 183 switch ( eMode )
paleskyjp 0:62be54b8975d 184 {
paleskyjp 0:62be54b8975d 185 /* Pass current register values to the protocol stack. */
paleskyjp 0:62be54b8975d 186 case MB_REG_READ:
paleskyjp 0:62be54b8975d 187 while( usNRegs > 0 )
paleskyjp 0:62be54b8975d 188 {
paleskyjp 0:62be54b8975d 189 *pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] >> 8 );
paleskyjp 0:62be54b8975d 190 *pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] & 0xFF );
paleskyjp 0:62be54b8975d 191 iRegIndex++;
paleskyjp 0:62be54b8975d 192 usNRegs--;
paleskyjp 0:62be54b8975d 193 }
paleskyjp 0:62be54b8975d 194 break;
paleskyjp 0:62be54b8975d 195
paleskyjp 0:62be54b8975d 196 /* Update current register values with new values from the
paleskyjp 0:62be54b8975d 197 * protocol stack. */
paleskyjp 0:62be54b8975d 198 case MB_REG_WRITE:
paleskyjp 0:62be54b8975d 199 while( usNRegs > 0 )
paleskyjp 0:62be54b8975d 200 {
paleskyjp 0:62be54b8975d 201 usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
paleskyjp 0:62be54b8975d 202 usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
paleskyjp 0:62be54b8975d 203 iRegIndex++;
paleskyjp 0:62be54b8975d 204 usNRegs--;
paleskyjp 0:62be54b8975d 205 }
paleskyjp 0:62be54b8975d 206 }
paleskyjp 0:62be54b8975d 207 }
paleskyjp 0:62be54b8975d 208 else
paleskyjp 0:62be54b8975d 209 {
paleskyjp 0:62be54b8975d 210 eStatus = MB_ENOREG;
paleskyjp 0:62be54b8975d 211 }
paleskyjp 0:62be54b8975d 212 return eStatus;
lincina 4:97b3bd92b315 213
lincina 4:97b3bd92b315 214
paleskyjp 0:62be54b8975d 215 }
paleskyjp 0:62be54b8975d 216
paleskyjp 0:62be54b8975d 217 /*
paleskyjp 0:62be54b8975d 218 * Following implementation is not actually checked.
paleskyjp 0:62be54b8975d 219 */
paleskyjp 0:62be54b8975d 220
paleskyjp 0:62be54b8975d 221 eMBErrorCode
paleskyjp 0:62be54b8975d 222 eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode )
paleskyjp 0:62be54b8975d 223 {
paleskyjp 0:62be54b8975d 224 eMBErrorCode eStatus = MB_ENOERR;
paleskyjp 0:62be54b8975d 225 int iIntRegIndex;
paleskyjp 0:62be54b8975d 226 int iIntBufNum;
paleskyjp 0:62be54b8975d 227 int iIntBitNum;
paleskyjp 0:62be54b8975d 228 int iExtRegIndex=0;
paleskyjp 0:62be54b8975d 229 int iExtBufNum;
paleskyjp 0:62be54b8975d 230 int iExtBitNum;
paleskyjp 0:62be54b8975d 231 UCHAR ucTemp;
paleskyjp 0:62be54b8975d 232 if( ( usAddress >= REG_COIL_START )
paleskyjp 0:62be54b8975d 233 && ( usAddress + usNCoils <= REG_COIL_START + REG_COIL_NREGS ) )
paleskyjp 0:62be54b8975d 234 {
paleskyjp 0:62be54b8975d 235 iIntRegIndex = ( int )( usAddress - usRegCoilStart );
paleskyjp 0:62be54b8975d 236
paleskyjp 0:62be54b8975d 237 while( usNCoils > 0 )
paleskyjp 0:62be54b8975d 238 {
paleskyjp 0:62be54b8975d 239 iIntBufNum=iIntRegIndex/8;
paleskyjp 0:62be54b8975d 240 iIntBitNum=iIntRegIndex%8;
paleskyjp 0:62be54b8975d 241 iExtBufNum=iExtRegIndex/8;
paleskyjp 0:62be54b8975d 242 iExtBitNum=iExtRegIndex%8;
paleskyjp 0:62be54b8975d 243
paleskyjp 0:62be54b8975d 244 switch ( eMode )
paleskyjp 0:62be54b8975d 245 {
paleskyjp 0:62be54b8975d 246 case MB_REG_READ:
paleskyjp 0:62be54b8975d 247 // Read coils
paleskyjp 0:62be54b8975d 248 if(iExtBitNum==0){
paleskyjp 0:62be54b8975d 249 pucRegBuffer[iExtBufNum]=0;
paleskyjp 0:62be54b8975d 250 }
paleskyjp 0:62be54b8975d 251 ucTemp=(usRegCoilBuf[iIntBufNum]>>iIntBitNum) & 1;
paleskyjp 0:62be54b8975d 252 pucRegBuffer[iExtBufNum]|=ucTemp<<iExtBitNum;
paleskyjp 0:62be54b8975d 253 break;
paleskyjp 0:62be54b8975d 254
paleskyjp 0:62be54b8975d 255 case MB_REG_WRITE:
paleskyjp 0:62be54b8975d 256 // Write coils
paleskyjp 3:d7d7c67f21fa 257 ucTemp=usRegCoilBuf[iIntBufNum]&(~(1<<iIntBitNum));
paleskyjp 3:d7d7c67f21fa 258 ucTemp|=((pucRegBuffer[iExtBufNum]>>iExtBitNum) & 1)<<iIntBitNum;
paleskyjp 3:d7d7c67f21fa 259 usRegCoilBuf[iIntBufNum]=ucTemp;
paleskyjp 0:62be54b8975d 260 break;
paleskyjp 0:62be54b8975d 261 }
paleskyjp 0:62be54b8975d 262 iIntRegIndex++;
paleskyjp 0:62be54b8975d 263 iExtRegIndex++;
paleskyjp 0:62be54b8975d 264 usNCoils--;
paleskyjp 0:62be54b8975d 265
paleskyjp 0:62be54b8975d 266 }
paleskyjp 0:62be54b8975d 267 }
paleskyjp 0:62be54b8975d 268 else
paleskyjp 0:62be54b8975d 269 {
paleskyjp 0:62be54b8975d 270 eStatus = MB_ENOREG;
paleskyjp 0:62be54b8975d 271 }
paleskyjp 0:62be54b8975d 272
paleskyjp 0:62be54b8975d 273 return eStatus;
paleskyjp 0:62be54b8975d 274 }
paleskyjp 0:62be54b8975d 275
paleskyjp 0:62be54b8975d 276 eMBErrorCode
paleskyjp 0:62be54b8975d 277 eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
paleskyjp 0:62be54b8975d 278 {
paleskyjp 0:62be54b8975d 279 eMBErrorCode eStatus = MB_ENOERR;
paleskyjp 0:62be54b8975d 280 int iIntRegIndex;
paleskyjp 0:62be54b8975d 281 int iIntBufNum;
paleskyjp 0:62be54b8975d 282 int iIntBitNum;
paleskyjp 0:62be54b8975d 283 int iExtRegIndex=0;
paleskyjp 0:62be54b8975d 284 int iExtBufNum;
paleskyjp 0:62be54b8975d 285 int iExtBitNum;
paleskyjp 0:62be54b8975d 286 UCHAR ucTemp;
paleskyjp 0:62be54b8975d 287 if( ( usAddress >= REG_DISC_START )
paleskyjp 0:62be54b8975d 288 && ( usAddress + usNDiscrete <= REG_DISC_START + REG_DISC_NREGS ) )
paleskyjp 0:62be54b8975d 289 {
paleskyjp 0:62be54b8975d 290 iIntRegIndex = ( int )( usAddress - usRegDiscStart );
paleskyjp 0:62be54b8975d 291
paleskyjp 0:62be54b8975d 292 while( usNDiscrete > 0 )
paleskyjp 0:62be54b8975d 293 {
paleskyjp 0:62be54b8975d 294 iIntBufNum=iIntRegIndex/8;
paleskyjp 0:62be54b8975d 295 iIntBitNum=iIntRegIndex%8;
paleskyjp 0:62be54b8975d 296 iExtBufNum=iExtRegIndex/8;
paleskyjp 0:62be54b8975d 297 iExtBitNum=iExtRegIndex%8;
paleskyjp 0:62be54b8975d 298
paleskyjp 0:62be54b8975d 299 // Read discrete inputs
paleskyjp 0:62be54b8975d 300 if(iExtBitNum==0){
paleskyjp 0:62be54b8975d 301 pucRegBuffer[iExtBufNum]=0;
paleskyjp 0:62be54b8975d 302 }
paleskyjp 0:62be54b8975d 303 ucTemp=(usRegDiscBuf[iIntBufNum]>>iIntBitNum) & 1;
paleskyjp 0:62be54b8975d 304 pucRegBuffer[iExtBufNum]|=ucTemp<<iExtBitNum;
paleskyjp 0:62be54b8975d 305
paleskyjp 0:62be54b8975d 306 iIntRegIndex++;
paleskyjp 0:62be54b8975d 307 iExtRegIndex++;
paleskyjp 0:62be54b8975d 308 usNDiscrete--;
paleskyjp 0:62be54b8975d 309
paleskyjp 0:62be54b8975d 310 }
paleskyjp 0:62be54b8975d 311 }
paleskyjp 0:62be54b8975d 312 else
paleskyjp 0:62be54b8975d 313 {
paleskyjp 0:62be54b8975d 314 eStatus = MB_ENOREG;
paleskyjp 0:62be54b8975d 315 }
paleskyjp 0:62be54b8975d 316
paleskyjp 0:62be54b8975d 317 return eStatus;
paleskyjp 0:62be54b8975d 318 }