mbfuncfile.c 4.2 KB

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