Yuji Hosogaya / Mbed 2 deprecated ModbusTCP_light

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed lwip

main.cpp@0:8ee5ec4bcec2, 2012-03-16 (annotated)

Committer:
paleskyjp
Date:
Fri Mar 16 08:30:23 2012 +0000
Revision:
0:8ee5ec4bcec2
Child:
1:59cee932f289

        

        
Who changed what in which revision?

        

            
                
UserRevisionLine numberNew 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

DigitalOut ledLink(p30);





paleskyjp

0:8ee5ec4bcec2


    27

DigitalOut ledActivity(p29);





paleskyjp

0:8ee5ec4bcec2


    28

DigitalOut ledStage0 (LED1);





paleskyjp

0:8ee5ec4bcec2


    29

DigitalOut ledStage1 (LED2);





paleskyjp

0:8ee5ec4bcec2


    30

DigitalOut ledStage2 (LED3);





paleskyjp

0:8ee5ec4bcec2


    31

DigitalOut ledTCP80 (LED4);





paleskyjp

0:8ee5ec4bcec2


    32







paleskyjp

0:8ee5ec4bcec2


    33

volatile char stage = 0;





paleskyjp

0:8ee5ec4bcec2


    34







paleskyjp

0:8ee5ec4bcec2


    35

Serial pc(USBTX, USBRX);





paleskyjp

0:8ee5ec4bcec2


    36







paleskyjp

0:8ee5ec4bcec2


    37

/* ----------------------- Defines ------------------------------------------*/





paleskyjp

0:8ee5ec4bcec2


    38

#define REG_INPUT_START 1001





paleskyjp

0:8ee5ec4bcec2


    39

#define REG_INPUT_NREGS 4





paleskyjp

0:8ee5ec4bcec2


    40







paleskyjp

0:8ee5ec4bcec2


    41

#define REG_HOLDING_START       2001





paleskyjp

0:8ee5ec4bcec2


    42

#define REG_HOLDING_NREGS       130





paleskyjp

0:8ee5ec4bcec2


    43







paleskyjp

0:8ee5ec4bcec2


    44

#define REG_COIL_START (3000+1)





paleskyjp

0:8ee5ec4bcec2


    45

#define REG_COIL_NREGS 8





paleskyjp

0:8ee5ec4bcec2


    46

#define REG_COIL_BYTES REG_COIL_NREGS/8





paleskyjp

0:8ee5ec4bcec2


    47







paleskyjp

0:8ee5ec4bcec2


    48

#define REG_DISC_START (4000+1)





paleskyjp

0:8ee5ec4bcec2


    49

#define REG_DISC_NREGS 8





paleskyjp

0:8ee5ec4bcec2


    50

#define REG_DISC_BYTES REG_DISC_NREGS/8





paleskyjp

0:8ee5ec4bcec2


    51







paleskyjp

0:8ee5ec4bcec2


    52

#define SLAVE_ID 0x0A





paleskyjp

0:8ee5ec4bcec2


    53







paleskyjp

0:8ee5ec4bcec2


    54

/* ----------------------- Static variables ---------------------------------*/





paleskyjp

0:8ee5ec4bcec2


    55

static USHORT   usRegInputStart = REG_INPUT_START;





paleskyjp

0:8ee5ec4bcec2


    56

static USHORT   usRegInputBuf[REG_INPUT_NREGS]={0x0123,0x4567,0x89AB,0xCDEF};





paleskyjp

0:8ee5ec4bcec2


    57

static USHORT   usRegHoldingStart = REG_HOLDING_START;





paleskyjp

0:8ee5ec4bcec2


    58

static USHORT   usRegHoldingBuf[REG_HOLDING_NREGS]={0x0123,0x4567,0x89AB,0xCDEF,0xDEAD,0xBEEF,0xDEAD,0xBEEF,0xDEAD,0xBEEF};





paleskyjp

0:8ee5ec4bcec2


    59

static USHORT    usRegCoilStart = REG_COIL_START;





paleskyjp

0:8ee5ec4bcec2


    60

static UCHAR     usRegCoilBuf[REG_COIL_BYTES]={0xA5};





paleskyjp

0:8ee5ec4bcec2


    61

static USHORT    usRegDiscStart = REG_DISC_START;





paleskyjp

0:8ee5ec4bcec2


    62

static UCHAR     usRegDiscBuf[REG_DISC_BYTES]={0x5A};





paleskyjp

0:8ee5ec4bcec2


    63







paleskyjp

0:8ee5ec4bcec2


    64

/* ----------------------- Start implementation -----------------------------*/





paleskyjp

0:8ee5ec4bcec2


    65







paleskyjp

0:8ee5ec4bcec2


    66

int main() {





paleskyjp

0:8ee5ec4bcec2


    67

    pc.baud(115200);





paleskyjp

0:8ee5ec4bcec2


    68

    mb_init();





paleskyjp

0:8ee5ec4bcec2


    69







paleskyjp

0:8ee5ec4bcec2


    70

    while(1) {





paleskyjp

0:8ee5ec4bcec2


    71

        device_poll();





paleskyjp

0:8ee5ec4bcec2


    72

    }





paleskyjp

0:8ee5ec4bcec2


    73

}





paleskyjp

0:8ee5ec4bcec2


    74







paleskyjp

0:8ee5ec4bcec2


    75

eMBErrorCode





paleskyjp

0:8ee5ec4bcec2


    76

eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )





paleskyjp

0:8ee5ec4bcec2


    77

{





paleskyjp

0:8ee5ec4bcec2


    78

    eMBErrorCode    eStatus = MB_ENOERR;





paleskyjp

0:8ee5ec4bcec2


    79

    int             iRegIndex;





paleskyjp

0:8ee5ec4bcec2


    80







paleskyjp

0:8ee5ec4bcec2


    81

    if( ( usAddress >= REG_INPUT_START )





paleskyjp

0:8ee5ec4bcec2


    82

        && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )





paleskyjp

0:8ee5ec4bcec2


    83

    {





paleskyjp

0:8ee5ec4bcec2


    84

        iRegIndex = ( int )( usAddress - usRegInputStart );





paleskyjp

0:8ee5ec4bcec2


    85

        while( usNRegs > 0 )





paleskyjp

0:8ee5ec4bcec2


    86

        {





paleskyjp

0:8ee5ec4bcec2


    87

            *pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] >> 8 );





paleskyjp

0:8ee5ec4bcec2


    88

            *pucRegBuffer++ = ( unsigned char )( usRegInputBuf[iRegIndex] & 0xFF );





paleskyjp

0:8ee5ec4bcec2


    89

            iRegIndex++;





paleskyjp

0:8ee5ec4bcec2


    90

            usNRegs--;





paleskyjp

0:8ee5ec4bcec2


    91

        }





paleskyjp

0:8ee5ec4bcec2


    92

    }





paleskyjp

0:8ee5ec4bcec2


    93

    else





paleskyjp

0:8ee5ec4bcec2


    94

    {





paleskyjp

0:8ee5ec4bcec2


    95

        eStatus = MB_ENOREG;





paleskyjp

0:8ee5ec4bcec2


    96

    }





paleskyjp

0:8ee5ec4bcec2


    97

    return eStatus;





paleskyjp

0:8ee5ec4bcec2


    98

}





paleskyjp

0:8ee5ec4bcec2


    99







paleskyjp

0:8ee5ec4bcec2


   100

eMBErrorCode





paleskyjp

0:8ee5ec4bcec2


   101

eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )





paleskyjp

0:8ee5ec4bcec2


   102

{





paleskyjp

0:8ee5ec4bcec2


   103

    eMBErrorCode    eStatus = MB_ENOERR;





paleskyjp

0:8ee5ec4bcec2


   104

    int             iRegIndex;





paleskyjp

0:8ee5ec4bcec2


   105







paleskyjp

0:8ee5ec4bcec2


   106

    if( ( usAddress >= REG_HOLDING_START ) &&





paleskyjp

0:8ee5ec4bcec2


   107

        ( usAddress + usNRegs <= REG_HOLDING_START + REG_HOLDING_NREGS ) )





paleskyjp

0:8ee5ec4bcec2


   108

    {





paleskyjp

0:8ee5ec4bcec2


   109

        iRegIndex = ( int )( usAddress - usRegHoldingStart );





paleskyjp

0:8ee5ec4bcec2


   110

        switch ( eMode )





paleskyjp

0:8ee5ec4bcec2


   111

        {





paleskyjp

0:8ee5ec4bcec2


   112

            /* Pass current register values to the protocol stack. */





paleskyjp

0:8ee5ec4bcec2


   113

        case MB_REG_READ:





paleskyjp

0:8ee5ec4bcec2


   114

            while( usNRegs > 0 )





paleskyjp

0:8ee5ec4bcec2


   115

            {





paleskyjp

0:8ee5ec4bcec2


   116

                *pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] >> 8 );





paleskyjp

0:8ee5ec4bcec2


   117

                *pucRegBuffer++ = ( UCHAR ) ( usRegHoldingBuf[iRegIndex] & 0xFF );





paleskyjp

0:8ee5ec4bcec2


   118

                iRegIndex++;





paleskyjp

0:8ee5ec4bcec2


   119

                usNRegs--;





paleskyjp

0:8ee5ec4bcec2


   120

            }





paleskyjp

0:8ee5ec4bcec2


   121

            break;





paleskyjp

0:8ee5ec4bcec2


   122







paleskyjp

0:8ee5ec4bcec2


   123

            /* Update current register values with new values from the





paleskyjp

0:8ee5ec4bcec2


   124

             * protocol stack. */





paleskyjp

0:8ee5ec4bcec2


   125

        case MB_REG_WRITE:





paleskyjp

0:8ee5ec4bcec2


   126

            while( usNRegs > 0 )





paleskyjp

0:8ee5ec4bcec2


   127

            {





paleskyjp

0:8ee5ec4bcec2


   128

                usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;





paleskyjp

0:8ee5ec4bcec2


   129

                usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;





paleskyjp

0:8ee5ec4bcec2


   130

                iRegIndex++;





paleskyjp

0:8ee5ec4bcec2


   131

                usNRegs--;





paleskyjp

0:8ee5ec4bcec2


   132

            }





paleskyjp

0:8ee5ec4bcec2


   133

        }





paleskyjp

0:8ee5ec4bcec2


   134

    }





paleskyjp

0:8ee5ec4bcec2


   135

    else





paleskyjp

0:8ee5ec4bcec2


   136

    {





paleskyjp

0:8ee5ec4bcec2


   137

        eStatus = MB_ENOREG;





paleskyjp

0:8ee5ec4bcec2


   138

    }





paleskyjp

0:8ee5ec4bcec2


   139

    return eStatus;





paleskyjp

0:8ee5ec4bcec2


   140

}





paleskyjp

0:8ee5ec4bcec2


   141







paleskyjp

0:8ee5ec4bcec2


   142

/* 





paleskyjp

0:8ee5ec4bcec2


   143

 * Following implementation is not actually checked.





paleskyjp

0:8ee5ec4bcec2


   144

 */





paleskyjp

0:8ee5ec4bcec2


   145







paleskyjp

0:8ee5ec4bcec2


   146

eMBErrorCode





paleskyjp

0:8ee5ec4bcec2


   147

eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode )





paleskyjp

0:8ee5ec4bcec2


   148

{





paleskyjp

0:8ee5ec4bcec2


   149

    eMBErrorCode    eStatus = MB_ENOERR;





paleskyjp

0:8ee5ec4bcec2


   150

    int             iIntRegIndex;





paleskyjp

0:8ee5ec4bcec2


   151

    int                iIntBufNum;





paleskyjp

0:8ee5ec4bcec2


   152

    int                iIntBitNum;





paleskyjp

0:8ee5ec4bcec2


   153

    int                iExtRegIndex=0;





paleskyjp

0:8ee5ec4bcec2


   154

    int                iExtBufNum;





paleskyjp

0:8ee5ec4bcec2


   155

    int                iExtBitNum;





paleskyjp

0:8ee5ec4bcec2


   156

    UCHAR            ucTemp;





paleskyjp

0:8ee5ec4bcec2


   157

    if( ( usAddress >= REG_COIL_START )





paleskyjp

0:8ee5ec4bcec2


   158

        && ( usAddress + usNCoils <= REG_COIL_START + REG_COIL_NREGS ) )





paleskyjp

0:8ee5ec4bcec2


   159

    {





paleskyjp

0:8ee5ec4bcec2


   160

        iIntRegIndex = ( int )( usAddress - usRegCoilStart );





paleskyjp

0:8ee5ec4bcec2


   161







paleskyjp

0:8ee5ec4bcec2


   162

        while( usNCoils > 0 )





paleskyjp

0:8ee5ec4bcec2


   163

        {





paleskyjp

0:8ee5ec4bcec2


   164

            iIntBufNum=iIntRegIndex/8;





paleskyjp

0:8ee5ec4bcec2


   165

            iIntBitNum=iIntRegIndex%8;





paleskyjp

0:8ee5ec4bcec2


   166

            iExtBufNum=iExtRegIndex/8;





paleskyjp

0:8ee5ec4bcec2


   167

            iExtBitNum=iExtRegIndex%8;





paleskyjp

0:8ee5ec4bcec2


   168







paleskyjp

0:8ee5ec4bcec2


   169

            switch ( eMode )





paleskyjp

0:8ee5ec4bcec2


   170

            {





paleskyjp

0:8ee5ec4bcec2


   171

            case MB_REG_READ:





paleskyjp

0:8ee5ec4bcec2


   172

                // Read coils





paleskyjp

0:8ee5ec4bcec2


   173

                if(iExtBitNum==0){





paleskyjp

0:8ee5ec4bcec2


   174

                    pucRegBuffer[iExtBufNum]=0;





paleskyjp

0:8ee5ec4bcec2


   175

                }





paleskyjp

0:8ee5ec4bcec2


   176

                ucTemp=(usRegCoilBuf[iIntBufNum]>>iIntBitNum) & 1;





paleskyjp

0:8ee5ec4bcec2


   177

                pucRegBuffer[iExtBufNum]|=ucTemp<<iExtBitNum;





paleskyjp

0:8ee5ec4bcec2


   178

                break;





paleskyjp

0:8ee5ec4bcec2


   179







paleskyjp

0:8ee5ec4bcec2


   180

            case MB_REG_WRITE:





paleskyjp

0:8ee5ec4bcec2


   181

                // Write coils





paleskyjp

0:8ee5ec4bcec2


   182

                ucTemp=usRegCoilBuf[iIntBufNum]&(~(1<<iIntBitNum));





paleskyjp

0:8ee5ec4bcec2


   183

                ucTemp|=((pucRegBuffer[iExtBufNum]>>iExtBitNum) & 1)<<iIntBitNum;





paleskyjp

0:8ee5ec4bcec2


   184

                usRegCoilBuf[iIntBufNum]=ucTemp;





paleskyjp

0:8ee5ec4bcec2


   185

                break;





paleskyjp

0:8ee5ec4bcec2


   186

            }





paleskyjp

0:8ee5ec4bcec2


   187

            iIntRegIndex++;





paleskyjp

0:8ee5ec4bcec2


   188

            iExtRegIndex++;





paleskyjp

0:8ee5ec4bcec2


   189

            usNCoils--;





paleskyjp

0:8ee5ec4bcec2


   190







paleskyjp

0:8ee5ec4bcec2


   191

        }





paleskyjp

0:8ee5ec4bcec2


   192

    }





paleskyjp

0:8ee5ec4bcec2


   193

    else





paleskyjp

0:8ee5ec4bcec2


   194

    {





paleskyjp

0:8ee5ec4bcec2


   195

        eStatus = MB_ENOREG;





paleskyjp

0:8ee5ec4bcec2


   196

    }





paleskyjp

0:8ee5ec4bcec2


   197







paleskyjp

0:8ee5ec4bcec2


   198

    return eStatus;





paleskyjp

0:8ee5ec4bcec2


   199

}





paleskyjp

0:8ee5ec4bcec2


   200







paleskyjp

0:8ee5ec4bcec2


   201

eMBErrorCode





paleskyjp

0:8ee5ec4bcec2


   202

eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )





paleskyjp

0:8ee5ec4bcec2


   203

{





paleskyjp

0:8ee5ec4bcec2


   204

    eMBErrorCode    eStatus = MB_ENOERR;





paleskyjp

0:8ee5ec4bcec2


   205

    int             iIntRegIndex;





paleskyjp

0:8ee5ec4bcec2


   206

    int                iIntBufNum;





paleskyjp

0:8ee5ec4bcec2


   207

    int                iIntBitNum;





paleskyjp

0:8ee5ec4bcec2


   208

    int                iExtRegIndex=0;





paleskyjp

0:8ee5ec4bcec2


   209

    int                iExtBufNum;





paleskyjp

0:8ee5ec4bcec2


   210

    int                iExtBitNum;





paleskyjp

0:8ee5ec4bcec2


   211

    UCHAR            ucTemp;





paleskyjp

0:8ee5ec4bcec2


   212

    if( ( usAddress >= REG_DISC_START )





paleskyjp

0:8ee5ec4bcec2


   213

        && ( usAddress + usNDiscrete <= REG_DISC_START + REG_DISC_NREGS ) )





paleskyjp

0:8ee5ec4bcec2


   214

    {





paleskyjp

0:8ee5ec4bcec2


   215

        iIntRegIndex = ( int )( usAddress - usRegDiscStart );





paleskyjp

0:8ee5ec4bcec2


   216







paleskyjp

0:8ee5ec4bcec2


   217

        while( usNDiscrete > 0 )





paleskyjp

0:8ee5ec4bcec2


   218

        {





paleskyjp

0:8ee5ec4bcec2


   219

            iIntBufNum=iIntRegIndex/8;





paleskyjp

0:8ee5ec4bcec2


   220

            iIntBitNum=iIntRegIndex%8;





paleskyjp

0:8ee5ec4bcec2


   221

            iExtBufNum=iExtRegIndex/8;





paleskyjp

0:8ee5ec4bcec2


   222

            iExtBitNum=iExtRegIndex%8;





paleskyjp

0:8ee5ec4bcec2


   223







paleskyjp

0:8ee5ec4bcec2


   224

            // Read discrete inputs





paleskyjp

0:8ee5ec4bcec2


   225

            if(iExtBitNum==0){





paleskyjp

0:8ee5ec4bcec2


   226

                pucRegBuffer[iExtBufNum]=0;





paleskyjp

0:8ee5ec4bcec2


   227

            }





paleskyjp

0:8ee5ec4bcec2


   228

            ucTemp=(usRegDiscBuf[iIntBufNum]>>iIntBitNum) & 1;





paleskyjp

0:8ee5ec4bcec2


   229

            pucRegBuffer[iExtBufNum]|=ucTemp<<iExtBitNum;





paleskyjp

0:8ee5ec4bcec2


   230







paleskyjp

0:8ee5ec4bcec2


   231

            iIntRegIndex++;





paleskyjp

0:8ee5ec4bcec2


   232

            iExtRegIndex++;





paleskyjp

0:8ee5ec4bcec2


   233

            usNDiscrete--;





paleskyjp

0:8ee5ec4bcec2


   234







paleskyjp

0:8ee5ec4bcec2


   235

        }





paleskyjp

0:8ee5ec4bcec2


   236

    }





paleskyjp

0:8ee5ec4bcec2


   237

    else





paleskyjp

0:8ee5ec4bcec2


   238

    {





paleskyjp

0:8ee5ec4bcec2


   239

        eStatus = MB_ENOREG;





paleskyjp

0:8ee5ec4bcec2


   240

    }





paleskyjp

0:8ee5ec4bcec2


   241







paleskyjp

0:8ee5ec4bcec2


   242

    return eStatus;





paleskyjp

0:8ee5ec4bcec2


   243

}