ModbusTCP Light This version utilize lwIP library with the minimal implementation of Modbus TCP. Error processing hasn\\\'t been implemented yet.
main.cpp@1:59cee932f289, 2012-03-16 (annotated)
- Committer:
- paleskyjp
- Date:
- Fri Mar 16 08:38:12 2012 +0000
- Revision:
- 1:59cee932f289
- Parent:
- 0:8ee5ec4bcec2
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
paleskyjp | 0:8ee5ec4bcec2 | 1 | /* |
paleskyjp | 0:8ee5ec4bcec2 | 2 | * FreeModbus Libary: BARE Demo Application |
paleskyjp | 0:8ee5ec4bcec2 | 3 | * Copyright (C) 2006 Christian Walter <wolti@sil.at> |
paleskyjp | 0:8ee5ec4bcec2 | 4 | * |
paleskyjp | 0:8ee5ec4bcec2 | 5 | * This program is free software; you can redistribute it and/or modify |
paleskyjp | 0:8ee5ec4bcec2 | 6 | * it under the terms of the GNU General Public License as published by |
paleskyjp | 0:8ee5ec4bcec2 | 7 | * the Free Software Foundation; either version 2 of the License, or |
paleskyjp | 0:8ee5ec4bcec2 | 8 | * (at your option) any later version. |
paleskyjp | 0:8ee5ec4bcec2 | 9 | * |
paleskyjp | 0:8ee5ec4bcec2 | 10 | * This program is distributed in the hope that it will be useful, |
paleskyjp | 0:8ee5ec4bcec2 | 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
paleskyjp | 0:8ee5ec4bcec2 | 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
paleskyjp | 0:8ee5ec4bcec2 | 13 | * GNU General Public License for more details. |
paleskyjp | 0:8ee5ec4bcec2 | 14 | * |
paleskyjp | 0:8ee5ec4bcec2 | 15 | * You should have received a copy of the GNU General Public License |
paleskyjp | 0:8ee5ec4bcec2 | 16 | * along with this program; if not, write to the Free Software |
paleskyjp | 0:8ee5ec4bcec2 | 17 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
paleskyjp | 0:8ee5ec4bcec2 | 18 | * |
paleskyjp | 0:8ee5ec4bcec2 | 19 | * File: $Id: demo.c,v 1.1 2006/08/22 21:35:13 wolti Exp $ |
paleskyjp | 0:8ee5ec4bcec2 | 20 | |
paleskyjp | 0:8ee5ec4bcec2 | 21 | * modified from: Thanassis Mavrogeorgiadis 5-12-2011 |
paleskyjp | 0:8ee5ec4bcec2 | 22 | * modified by Yuji Hosogaya 3-16-2012 |
paleskyjp | 0:8ee5ec4bcec2 | 23 | */ |
paleskyjp | 0:8ee5ec4bcec2 | 24 | #include "mbtcp.h" |
paleskyjp | 0:8ee5ec4bcec2 | 25 | |
paleskyjp | 0:8ee5ec4bcec2 | 26 | Serial pc(USBTX, USBRX); |
paleskyjp | 0:8ee5ec4bcec2 | 27 | |
paleskyjp | 0:8ee5ec4bcec2 | 28 | /* ----------------------- Defines ------------------------------------------*/ |
paleskyjp | 0:8ee5ec4bcec2 | 29 | #define REG_INPUT_START 1001 |
paleskyjp | 0:8ee5ec4bcec2 | 30 | #define REG_INPUT_NREGS 4 |
paleskyjp | 0:8ee5ec4bcec2 | 31 | |
paleskyjp | 0:8ee5ec4bcec2 | 32 | #define REG_HOLDING_START 2001 |
paleskyjp | 0:8ee5ec4bcec2 | 33 | #define REG_HOLDING_NREGS 130 |
paleskyjp | 0:8ee5ec4bcec2 | 34 | |
paleskyjp | 0:8ee5ec4bcec2 | 35 | #define REG_COIL_START (3000+1) |
paleskyjp | 0:8ee5ec4bcec2 | 36 | #define REG_COIL_NREGS 8 |
paleskyjp | 0:8ee5ec4bcec2 | 37 | #define REG_COIL_BYTES REG_COIL_NREGS/8 |
paleskyjp | 0:8ee5ec4bcec2 | 38 | |
paleskyjp | 0:8ee5ec4bcec2 | 39 | #define REG_DISC_START (4000+1) |
paleskyjp | 0:8ee5ec4bcec2 | 40 | #define REG_DISC_NREGS 8 |
paleskyjp | 0:8ee5ec4bcec2 | 41 | #define REG_DISC_BYTES REG_DISC_NREGS/8 |
paleskyjp | 0:8ee5ec4bcec2 | 42 | |
paleskyjp | 0:8ee5ec4bcec2 | 43 | #define SLAVE_ID 0x0A |
paleskyjp | 0:8ee5ec4bcec2 | 44 | |
paleskyjp | 0:8ee5ec4bcec2 | 45 | /* ----------------------- Static variables ---------------------------------*/ |
paleskyjp | 0:8ee5ec4bcec2 | 46 | static USHORT usRegInputStart = REG_INPUT_START; |
paleskyjp | 0:8ee5ec4bcec2 | 47 | static USHORT usRegInputBuf[REG_INPUT_NREGS]={0x0123,0x4567,0x89AB,0xCDEF}; |
paleskyjp | 0:8ee5ec4bcec2 | 48 | static USHORT usRegHoldingStart = REG_HOLDING_START; |
paleskyjp | 0:8ee5ec4bcec2 | 49 | static USHORT usRegHoldingBuf[REG_HOLDING_NREGS]={0x0123,0x4567,0x89AB,0xCDEF,0xDEAD,0xBEEF,0xDEAD,0xBEEF,0xDEAD,0xBEEF}; |
paleskyjp | 0:8ee5ec4bcec2 | 50 | static USHORT usRegCoilStart = REG_COIL_START; |
paleskyjp | 0:8ee5ec4bcec2 | 51 | static UCHAR usRegCoilBuf[REG_COIL_BYTES]={0xA5}; |
paleskyjp | 0:8ee5ec4bcec2 | 52 | static USHORT usRegDiscStart = REG_DISC_START; |
paleskyjp | 0:8ee5ec4bcec2 | 53 | static UCHAR usRegDiscBuf[REG_DISC_BYTES]={0x5A}; |
paleskyjp | 0:8ee5ec4bcec2 | 54 | |
paleskyjp | 0:8ee5ec4bcec2 | 55 | /* ----------------------- Start implementation -----------------------------*/ |
paleskyjp | 0:8ee5ec4bcec2 | 56 | |
paleskyjp | 0:8ee5ec4bcec2 | 57 | int main() { |
paleskyjp | 0:8ee5ec4bcec2 | 58 | pc.baud(115200); |
paleskyjp | 0:8ee5ec4bcec2 | 59 | mb_init(); |
paleskyjp | 0:8ee5ec4bcec2 | 60 | |
paleskyjp | 0:8ee5ec4bcec2 | 61 | while(1) { |
paleskyjp | 0:8ee5ec4bcec2 | 62 | device_poll(); |
paleskyjp | 0:8ee5ec4bcec2 | 63 | } |
paleskyjp | 0:8ee5ec4bcec2 | 64 | } |
paleskyjp | 0:8ee5ec4bcec2 | 65 | |
paleskyjp | 0:8ee5ec4bcec2 | 66 | eMBErrorCode |
paleskyjp | 0:8ee5ec4bcec2 | 67 | eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs ) |
paleskyjp | 0:8ee5ec4bcec2 | 68 | { |
paleskyjp | 0:8ee5ec4bcec2 | 69 | eMBErrorCode eStatus = MB_ENOERR; |
paleskyjp | 0:8ee5ec4bcec2 | 70 | int iRegIndex; |
paleskyjp | 0:8ee5ec4bcec2 | 71 | |
paleskyjp | 0:8ee5ec4bcec2 | 72 | if( ( usAddress >= REG_INPUT_START ) |
paleskyjp | 0:8ee5ec4bcec2 | 73 | && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) ) |
paleskyjp | 0:8ee5ec4bcec2 | 74 | { |
paleskyjp | 0:8ee5ec4bcec2 | 75 | iRegIndex = ( int )( usAddress - usRegInputStart ); |
paleskyjp | 0:8ee5ec4bcec2 | 76 | while( usNRegs > 0 ) |
paleskyjp | 0:8ee5ec4bcec2 | 77 | { |
paleskyjp | 0:8ee5ec4bcec2 | 78 | *pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] >> 8 ); |
paleskyjp | 0:8ee5ec4bcec2 | 79 | *pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] & 0xFF ); |
paleskyjp | 0:8ee5ec4bcec2 | 80 | iRegIndex++; |
paleskyjp | 0:8ee5ec4bcec2 | 81 | usNRegs--; |
paleskyjp | 0:8ee5ec4bcec2 | 82 | } |
paleskyjp | 0:8ee5ec4bcec2 | 83 | } |
paleskyjp | 0:8ee5ec4bcec2 | 84 | else |
paleskyjp | 0:8ee5ec4bcec2 | 85 | { |
paleskyjp | 0:8ee5ec4bcec2 | 86 | eStatus = MB_ENOREG; |
paleskyjp | 0:8ee5ec4bcec2 | 87 | } |
paleskyjp | 0:8ee5ec4bcec2 | 88 | return eStatus; |
paleskyjp | 0:8ee5ec4bcec2 | 89 | } |
paleskyjp | 0:8ee5ec4bcec2 | 90 | |
paleskyjp | 0:8ee5ec4bcec2 | 91 | eMBErrorCode |
paleskyjp | 0:8ee5ec4bcec2 | 92 | eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode ) |
paleskyjp | 0:8ee5ec4bcec2 | 93 | { |
paleskyjp | 0:8ee5ec4bcec2 | 94 | eMBErrorCode eStatus = MB_ENOERR; |
paleskyjp | 0:8ee5ec4bcec2 | 95 | int iRegIndex; |
paleskyjp | 0:8ee5ec4bcec2 | 96 | |
paleskyjp | 0:8ee5ec4bcec2 | 97 | if( ( usAddress >= REG_HOLDING_START ) && |
paleskyjp | 0:8ee5ec4bcec2 | 98 | ( usAddress + usNRegs <= REG_HOLDING_START + REG_HOLDING_NREGS ) ) |
paleskyjp | 0:8ee5ec4bcec2 | 99 | { |
paleskyjp | 0:8ee5ec4bcec2 | 100 | iRegIndex = ( int )( usAddress - usRegHoldingStart ); |
paleskyjp | 0:8ee5ec4bcec2 | 101 | switch ( eMode ) |
paleskyjp | 0:8ee5ec4bcec2 | 102 | { |
paleskyjp | 0:8ee5ec4bcec2 | 103 | /* Pass current register values to the protocol stack. */ |
paleskyjp | 0:8ee5ec4bcec2 | 104 | case MB_REG_READ: |
paleskyjp | 0:8ee5ec4bcec2 | 105 | while( usNRegs > 0 ) |
paleskyjp | 0:8ee5ec4bcec2 | 106 | { |
paleskyjp | 0:8ee5ec4bcec2 | 107 | *pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] >> 8 ); |
paleskyjp | 0:8ee5ec4bcec2 | 108 | *pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] & 0xFF ); |
paleskyjp | 0:8ee5ec4bcec2 | 109 | iRegIndex++; |
paleskyjp | 0:8ee5ec4bcec2 | 110 | usNRegs--; |
paleskyjp | 0:8ee5ec4bcec2 | 111 | } |
paleskyjp | 0:8ee5ec4bcec2 | 112 | break; |
paleskyjp | 0:8ee5ec4bcec2 | 113 | |
paleskyjp | 0:8ee5ec4bcec2 | 114 | /* Update current register values with new values from the |
paleskyjp | 0:8ee5ec4bcec2 | 115 | * protocol stack. */ |
paleskyjp | 0:8ee5ec4bcec2 | 116 | case MB_REG_WRITE: |
paleskyjp | 0:8ee5ec4bcec2 | 117 | while( usNRegs > 0 ) |
paleskyjp | 0:8ee5ec4bcec2 | 118 | { |
paleskyjp | 0:8ee5ec4bcec2 | 119 | usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8; |
paleskyjp | 0:8ee5ec4bcec2 | 120 | usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++; |
paleskyjp | 0:8ee5ec4bcec2 | 121 | iRegIndex++; |
paleskyjp | 0:8ee5ec4bcec2 | 122 | usNRegs--; |
paleskyjp | 0:8ee5ec4bcec2 | 123 | } |
paleskyjp | 0:8ee5ec4bcec2 | 124 | } |
paleskyjp | 0:8ee5ec4bcec2 | 125 | } |
paleskyjp | 0:8ee5ec4bcec2 | 126 | else |
paleskyjp | 0:8ee5ec4bcec2 | 127 | { |
paleskyjp | 0:8ee5ec4bcec2 | 128 | eStatus = MB_ENOREG; |
paleskyjp | 0:8ee5ec4bcec2 | 129 | } |
paleskyjp | 0:8ee5ec4bcec2 | 130 | return eStatus; |
paleskyjp | 0:8ee5ec4bcec2 | 131 | } |
paleskyjp | 0:8ee5ec4bcec2 | 132 | |
paleskyjp | 0:8ee5ec4bcec2 | 133 | /* |
paleskyjp | 0:8ee5ec4bcec2 | 134 | * Following implementation is not actually checked. |
paleskyjp | 0:8ee5ec4bcec2 | 135 | */ |
paleskyjp | 0:8ee5ec4bcec2 | 136 | |
paleskyjp | 0:8ee5ec4bcec2 | 137 | eMBErrorCode |
paleskyjp | 0:8ee5ec4bcec2 | 138 | eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode ) |
paleskyjp | 0:8ee5ec4bcec2 | 139 | { |
paleskyjp | 0:8ee5ec4bcec2 | 140 | eMBErrorCode eStatus = MB_ENOERR; |
paleskyjp | 0:8ee5ec4bcec2 | 141 | int iIntRegIndex; |
paleskyjp | 0:8ee5ec4bcec2 | 142 | int iIntBufNum; |
paleskyjp | 0:8ee5ec4bcec2 | 143 | int iIntBitNum; |
paleskyjp | 0:8ee5ec4bcec2 | 144 | int iExtRegIndex=0; |
paleskyjp | 0:8ee5ec4bcec2 | 145 | int iExtBufNum; |
paleskyjp | 0:8ee5ec4bcec2 | 146 | int iExtBitNum; |
paleskyjp | 0:8ee5ec4bcec2 | 147 | UCHAR ucTemp; |
paleskyjp | 0:8ee5ec4bcec2 | 148 | if( ( usAddress >= REG_COIL_START ) |
paleskyjp | 0:8ee5ec4bcec2 | 149 | && ( usAddress + usNCoils <= REG_COIL_START + REG_COIL_NREGS ) ) |
paleskyjp | 0:8ee5ec4bcec2 | 150 | { |
paleskyjp | 0:8ee5ec4bcec2 | 151 | iIntRegIndex = ( int )( usAddress - usRegCoilStart ); |
paleskyjp | 0:8ee5ec4bcec2 | 152 | |
paleskyjp | 0:8ee5ec4bcec2 | 153 | while( usNCoils > 0 ) |
paleskyjp | 0:8ee5ec4bcec2 | 154 | { |
paleskyjp | 0:8ee5ec4bcec2 | 155 | iIntBufNum=iIntRegIndex/8; |
paleskyjp | 0:8ee5ec4bcec2 | 156 | iIntBitNum=iIntRegIndex%8; |
paleskyjp | 0:8ee5ec4bcec2 | 157 | iExtBufNum=iExtRegIndex/8; |
paleskyjp | 0:8ee5ec4bcec2 | 158 | iExtBitNum=iExtRegIndex%8; |
paleskyjp | 0:8ee5ec4bcec2 | 159 | |
paleskyjp | 0:8ee5ec4bcec2 | 160 | switch ( eMode ) |
paleskyjp | 0:8ee5ec4bcec2 | 161 | { |
paleskyjp | 0:8ee5ec4bcec2 | 162 | case MB_REG_READ: |
paleskyjp | 0:8ee5ec4bcec2 | 163 | // Read coils |
paleskyjp | 0:8ee5ec4bcec2 | 164 | if(iExtBitNum==0){ |
paleskyjp | 0:8ee5ec4bcec2 | 165 | pucRegBuffer[iExtBufNum]=0; |
paleskyjp | 0:8ee5ec4bcec2 | 166 | } |
paleskyjp | 0:8ee5ec4bcec2 | 167 | ucTemp=(usRegCoilBuf[iIntBufNum]>>iIntBitNum) & 1; |
paleskyjp | 0:8ee5ec4bcec2 | 168 | pucRegBuffer[iExtBufNum]|=ucTemp<<iExtBitNum; |
paleskyjp | 0:8ee5ec4bcec2 | 169 | break; |
paleskyjp | 0:8ee5ec4bcec2 | 170 | |
paleskyjp | 0:8ee5ec4bcec2 | 171 | case MB_REG_WRITE: |
paleskyjp | 0:8ee5ec4bcec2 | 172 | // Write coils |
paleskyjp | 0:8ee5ec4bcec2 | 173 | ucTemp=usRegCoilBuf[iIntBufNum]&(~(1<<iIntBitNum)); |
paleskyjp | 0:8ee5ec4bcec2 | 174 | ucTemp|=((pucRegBuffer[iExtBufNum]>>iExtBitNum) & 1)<<iIntBitNum; |
paleskyjp | 0:8ee5ec4bcec2 | 175 | usRegCoilBuf[iIntBufNum]=ucTemp; |
paleskyjp | 0:8ee5ec4bcec2 | 176 | break; |
paleskyjp | 0:8ee5ec4bcec2 | 177 | } |
paleskyjp | 0:8ee5ec4bcec2 | 178 | iIntRegIndex++; |
paleskyjp | 0:8ee5ec4bcec2 | 179 | iExtRegIndex++; |
paleskyjp | 0:8ee5ec4bcec2 | 180 | usNCoils--; |
paleskyjp | 0:8ee5ec4bcec2 | 181 | |
paleskyjp | 0:8ee5ec4bcec2 | 182 | } |
paleskyjp | 0:8ee5ec4bcec2 | 183 | } |
paleskyjp | 0:8ee5ec4bcec2 | 184 | else |
paleskyjp | 0:8ee5ec4bcec2 | 185 | { |
paleskyjp | 0:8ee5ec4bcec2 | 186 | eStatus = MB_ENOREG; |
paleskyjp | 0:8ee5ec4bcec2 | 187 | } |
paleskyjp | 0:8ee5ec4bcec2 | 188 | |
paleskyjp | 0:8ee5ec4bcec2 | 189 | return eStatus; |
paleskyjp | 0:8ee5ec4bcec2 | 190 | } |
paleskyjp | 0:8ee5ec4bcec2 | 191 | |
paleskyjp | 0:8ee5ec4bcec2 | 192 | eMBErrorCode |
paleskyjp | 0:8ee5ec4bcec2 | 193 | eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete ) |
paleskyjp | 0:8ee5ec4bcec2 | 194 | { |
paleskyjp | 0:8ee5ec4bcec2 | 195 | eMBErrorCode eStatus = MB_ENOERR; |
paleskyjp | 0:8ee5ec4bcec2 | 196 | int iIntRegIndex; |
paleskyjp | 0:8ee5ec4bcec2 | 197 | int iIntBufNum; |
paleskyjp | 0:8ee5ec4bcec2 | 198 | int iIntBitNum; |
paleskyjp | 0:8ee5ec4bcec2 | 199 | int iExtRegIndex=0; |
paleskyjp | 0:8ee5ec4bcec2 | 200 | int iExtBufNum; |
paleskyjp | 0:8ee5ec4bcec2 | 201 | int iExtBitNum; |
paleskyjp | 0:8ee5ec4bcec2 | 202 | UCHAR ucTemp; |
paleskyjp | 0:8ee5ec4bcec2 | 203 | if( ( usAddress >= REG_DISC_START ) |
paleskyjp | 0:8ee5ec4bcec2 | 204 | && ( usAddress + usNDiscrete <= REG_DISC_START + REG_DISC_NREGS ) ) |
paleskyjp | 0:8ee5ec4bcec2 | 205 | { |
paleskyjp | 0:8ee5ec4bcec2 | 206 | iIntRegIndex = ( int )( usAddress - usRegDiscStart ); |
paleskyjp | 0:8ee5ec4bcec2 | 207 | |
paleskyjp | 0:8ee5ec4bcec2 | 208 | while( usNDiscrete > 0 ) |
paleskyjp | 0:8ee5ec4bcec2 | 209 | { |
paleskyjp | 0:8ee5ec4bcec2 | 210 | iIntBufNum=iIntRegIndex/8; |
paleskyjp | 0:8ee5ec4bcec2 | 211 | iIntBitNum=iIntRegIndex%8; |
paleskyjp | 0:8ee5ec4bcec2 | 212 | iExtBufNum=iExtRegIndex/8; |
paleskyjp | 0:8ee5ec4bcec2 | 213 | iExtBitNum=iExtRegIndex%8; |
paleskyjp | 0:8ee5ec4bcec2 | 214 | |
paleskyjp | 0:8ee5ec4bcec2 | 215 | // Read discrete inputs |
paleskyjp | 0:8ee5ec4bcec2 | 216 | if(iExtBitNum==0){ |
paleskyjp | 0:8ee5ec4bcec2 | 217 | pucRegBuffer[iExtBufNum]=0; |
paleskyjp | 0:8ee5ec4bcec2 | 218 | } |
paleskyjp | 0:8ee5ec4bcec2 | 219 | ucTemp=(usRegDiscBuf[iIntBufNum]>>iIntBitNum) & 1; |
paleskyjp | 0:8ee5ec4bcec2 | 220 | pucRegBuffer[iExtBufNum]|=ucTemp<<iExtBitNum; |
paleskyjp | 0:8ee5ec4bcec2 | 221 | |
paleskyjp | 0:8ee5ec4bcec2 | 222 | iIntRegIndex++; |
paleskyjp | 0:8ee5ec4bcec2 | 223 | iExtRegIndex++; |
paleskyjp | 0:8ee5ec4bcec2 | 224 | usNDiscrete--; |
paleskyjp | 0:8ee5ec4bcec2 | 225 | |
paleskyjp | 0:8ee5ec4bcec2 | 226 | } |
paleskyjp | 0:8ee5ec4bcec2 | 227 | } |
paleskyjp | 0:8ee5ec4bcec2 | 228 | else |
paleskyjp | 0:8ee5ec4bcec2 | 229 | { |
paleskyjp | 0:8ee5ec4bcec2 | 230 | eStatus = MB_ENOREG; |
paleskyjp | 0:8ee5ec4bcec2 | 231 | } |
paleskyjp | 0:8ee5ec4bcec2 | 232 | |
paleskyjp | 0:8ee5ec4bcec2 | 233 | return eStatus; |
paleskyjp | 0:8ee5ec4bcec2 | 234 | } |