1*10465441SEvalZero /*
2*10465441SEvalZero * FreeModbus Libary: A portable Modbus implementation for Modbus ASCII/RTU.
3*10465441SEvalZero * Copyright (c) 2006 Christian Walter <[email protected]>
4*10465441SEvalZero * All rights reserved.
5*10465441SEvalZero *
6*10465441SEvalZero * Redistribution and use in source and binary forms, with or without
7*10465441SEvalZero * modification, are permitted provided that the following conditions
8*10465441SEvalZero * are met:
9*10465441SEvalZero * 1. Redistributions of source code must retain the above copyright
10*10465441SEvalZero * notice, this list of conditions and the following disclaimer.
11*10465441SEvalZero * 2. Redistributions in binary form must reproduce the above copyright
12*10465441SEvalZero * notice, this list of conditions and the following disclaimer in the
13*10465441SEvalZero * documentation and/or other materials provided with the distribution.
14*10465441SEvalZero * 3. The name of the author may not be used to endorse or promote products
15*10465441SEvalZero * derived from this software without specific prior written permission.
16*10465441SEvalZero *
17*10465441SEvalZero * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18*10465441SEvalZero * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19*10465441SEvalZero * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20*10465441SEvalZero * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21*10465441SEvalZero * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22*10465441SEvalZero * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23*10465441SEvalZero * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24*10465441SEvalZero * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25*10465441SEvalZero * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26*10465441SEvalZero * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27*10465441SEvalZero *
28*10465441SEvalZero * File: $Id: mbfuncother.c,v 1.8 2006/12/07 22:10:34 wolti Exp $
29*10465441SEvalZero */
30*10465441SEvalZero
31*10465441SEvalZero /* ----------------------- System includes ----------------------------------*/
32*10465441SEvalZero #include "stdlib.h"
33*10465441SEvalZero #include "string.h"
34*10465441SEvalZero
35*10465441SEvalZero /* ----------------------- Platform includes --------------------------------*/
36*10465441SEvalZero #include "port.h"
37*10465441SEvalZero
38*10465441SEvalZero /* ----------------------- Modbus includes ----------------------------------*/
39*10465441SEvalZero #include "mb.h"
40*10465441SEvalZero #include "mbframe.h"
41*10465441SEvalZero #include "mbproto.h"
42*10465441SEvalZero #include "mbconfig.h"
43*10465441SEvalZero
44*10465441SEvalZero #if MB_FUNC_OTHER_REP_SLAVEID_ENABLED > 0
45*10465441SEvalZero
46*10465441SEvalZero /* ----------------------- Static variables ---------------------------------*/
47*10465441SEvalZero static UCHAR ucMBSlaveID[MB_FUNC_OTHER_REP_SLAVEID_BUF];
48*10465441SEvalZero static USHORT usMBSlaveIDLen;
49*10465441SEvalZero
50*10465441SEvalZero /* ----------------------- Start implementation -----------------------------*/
51*10465441SEvalZero
52*10465441SEvalZero eMBErrorCode
eMBSetSlaveID(UCHAR ucSlaveID,BOOL xIsRunning,UCHAR const * pucAdditional,USHORT usAdditionalLen)53*10465441SEvalZero eMBSetSlaveID( UCHAR ucSlaveID, BOOL xIsRunning,
54*10465441SEvalZero UCHAR const *pucAdditional, USHORT usAdditionalLen )
55*10465441SEvalZero {
56*10465441SEvalZero eMBErrorCode eStatus = MB_ENOERR;
57*10465441SEvalZero
58*10465441SEvalZero /* the first byte and second byte in the buffer is reserved for
59*10465441SEvalZero * the parameter ucSlaveID and the running flag. The rest of
60*10465441SEvalZero * the buffer is available for additional data. */
61*10465441SEvalZero if( usAdditionalLen + 2 < MB_FUNC_OTHER_REP_SLAVEID_BUF )
62*10465441SEvalZero {
63*10465441SEvalZero usMBSlaveIDLen = 0;
64*10465441SEvalZero ucMBSlaveID[usMBSlaveIDLen++] = ucSlaveID;
65*10465441SEvalZero ucMBSlaveID[usMBSlaveIDLen++] = ( UCHAR )( xIsRunning ? 0xFF : 0x00 );
66*10465441SEvalZero if( usAdditionalLen > 0 )
67*10465441SEvalZero {
68*10465441SEvalZero memcpy( &ucMBSlaveID[usMBSlaveIDLen], pucAdditional,
69*10465441SEvalZero ( size_t )usAdditionalLen );
70*10465441SEvalZero usMBSlaveIDLen += usAdditionalLen;
71*10465441SEvalZero }
72*10465441SEvalZero }
73*10465441SEvalZero else
74*10465441SEvalZero {
75*10465441SEvalZero eStatus = MB_ENORES;
76*10465441SEvalZero }
77*10465441SEvalZero return eStatus;
78*10465441SEvalZero }
79*10465441SEvalZero
80*10465441SEvalZero eMBException
eMBFuncReportSlaveID(UCHAR * pucFrame,USHORT * usLen)81*10465441SEvalZero eMBFuncReportSlaveID( UCHAR * pucFrame, USHORT * usLen )
82*10465441SEvalZero {
83*10465441SEvalZero memcpy( &pucFrame[MB_PDU_DATA_OFF], &ucMBSlaveID[0], ( size_t )usMBSlaveIDLen );
84*10465441SEvalZero *usLen = ( USHORT )( MB_PDU_DATA_OFF + usMBSlaveIDLen );
85*10465441SEvalZero return MB_EX_NONE;
86*10465441SEvalZero }
87*10465441SEvalZero
88*10465441SEvalZero #endif
89