Skip to content
Projects
Groups
Snippets
Help
This project
Loading...
Sign in / Register
Toggle navigation
U
uniset2
Project
Project
Details
Activity
Cycle Analytics
Repository
Repository
Files
Commits
Branches
Tags
Contributors
Graph
Compare
Charts
Issues
1
Issues
1
List
Board
Labels
Milestones
Merge Requests
0
Merge Requests
0
CI / CD
CI / CD
Pipelines
Jobs
Schedules
Charts
Wiki
Wiki
Members
Members
Collapse sidebar
Close sidebar
Activity
Graph
Charts
Create a new issue
Jobs
Commits
Issue Boards
Open sidebar
UniSet project repositories
uniset2
Commits
7a8e66a6
Commit
7a8e66a6
authored
Nov 26, 2011
by
Pavel Vainerman
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
(Modbus): Исправил ошибку (сдвиг не единицу) в обработке количества возвращаемых…
(Modbus): Исправил ошибку (сдвиг не единицу) в обработке количества возвращаемых байтов в функции 0x02
parent
8a6b7c58
Show whitespace changes
Inline
Side-by-side
Showing
5 changed files
with
102 additions
and
224 deletions
+102
-224
MBSlave.cc
Utilities/MBTester/MBSlave.cc
+3
-97
mbrtutester.cc
Utilities/MBTester/mbrtutester.cc
+6
-49
mbtcptester.cc
Utilities/MBTester/mbtcptester.cc
+4
-51
libuniset.spec
conf/libuniset.spec
+4
-1
MBSlave.cc
extensions/ModbusSlave/MBSlave.cc
+85
-26
No files found.
Utilities/MBTester/MBSlave.cc
View file @
7a8e66a6
...
@@ -3,27 +3,20 @@
...
@@ -3,27 +3,20 @@
//#include <string.h>
//#include <string.h>
//#include <errno.h>
//#include <errno.h>
#include <sstream>
#include <sstream>
#include
"UniSetTypes.h"
#include
<UniSetTypes.h>
#include "MBSlave.h"
#include "MBSlave.h"
#include "uniset-config.h"
// -------------------------------------------------------------------------
#ifndef PACKAGE_URL
#define PACKAGE_URL "http://git.etersoft.ru/projects/?p=asu/uniset.git;a=summary"
#endif
// -------------------------------------------------------------------------
// -------------------------------------------------------------------------
using
namespace
std
;
using
namespace
std
;
using
namespace
UniSetTypes
;
using
namespace
UniSetTypes
;
using
namespace
ModbusRTU
;
using
namespace
ModbusRTU
;
// -------------------------------------------------------------------------
// -------------------------------------------------------------------------
MBSlave
::
MBSlave
(
ModbusRTU
::
ModbusAddr
addr
,
const
std
::
string
&
dev
,
const
std
::
string
&
speed
,
bool
use485
)
:
MBSlave
::
MBSlave
(
ModbusRTU
::
ModbusAddr
addr
,
const
std
::
string
dev
,
const
std
::
string
speed
,
bool
use485
)
:
rscomm
(
NULL
),
rscomm
(
NULL
),
addr
(
addr
),
addr
(
addr
),
// prev(ModbusRTU::erNoError),
// prev(ModbusRTU::erNoError),
// askCount(0),
// askCount(0),
verbose
(
false
),
verbose
(
false
),
replyVal
(
-
1
),
replyVal
(
-
1
)
replyVal2
(
-
1
),
replyVal3
(
-
1
)
{
{
// int replyTimeout = uni_atoi( conf->getArgParam("--reply-timeout",it.getProp("reply_timeout")).c_str() );
// int replyTimeout = uni_atoi( conf->getArgParam("--reply-timeout",it.getProp("reply_timeout")).c_str() );
// if( replyTimeout <= 0 )
// if( replyTimeout <= 0 )
...
@@ -53,7 +46,6 @@ MBSlave::MBSlave( ModbusRTU::ModbusAddr addr, const std::string& dev, const std:
...
@@ -53,7 +46,6 @@ MBSlave::MBSlave( ModbusRTU::ModbusAddr addr, const std::string& dev, const std:
rscomm
->
connectRemoteService
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
remoteService
)
);
rscomm
->
connectRemoteService
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
remoteService
)
);
rscomm
->
connectFileTransfer
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
fileTransfer
)
);
rscomm
->
connectFileTransfer
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
fileTransfer
)
);
rscomm
->
connectDiagnostics
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
diagnostics
)
);
rscomm
->
connectDiagnostics
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
diagnostics
)
);
rscomm
->
connectMEIRDI
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
read4314
)
);
rscomm
->
setRecvTimeout
(
2000
);
rscomm
->
setRecvTimeout
(
2000
);
...
@@ -161,15 +153,8 @@ ModbusRTU::mbErrCode MBSlave::readInputStatus( ReadInputStatusMessage& query,
...
@@ -161,15 +153,8 @@ ModbusRTU::mbErrCode MBSlave::readInputStatus( ReadInputStatusMessage& query,
bcnt
++
;
bcnt
++
;
for
(
int
i
=
0
;
i
<
bcnt
;
i
++
)
for
(
int
i
=
0
;
i
<
bcnt
;
i
++
)
{
if
(
i
==
1
)
reply
.
addData
(
replyVal2
);
else
if
(
i
==
2
)
reply
.
addData
(
replyVal3
);
else
reply
.
addData
(
replyVal
);
reply
.
addData
(
replyVal
);
}
}
}
return
ModbusRTU
::
erNoError
;
return
ModbusRTU
::
erNoError
;
}
}
...
@@ -195,14 +180,7 @@ mbErrCode MBSlave::readInputRegisters( ReadInputMessage& query,
...
@@ -195,14 +180,7 @@ mbErrCode MBSlave::readInputRegisters( ReadInputMessage& query,
for
(
;
num
<
query
.
count
;
num
++
,
reg
++
)
for
(
;
num
<
query
.
count
;
num
++
,
reg
++
)
{
{
if
(
replyVal
!=
-
1
)
if
(
replyVal
!=
-
1
)
{
if
(
num
==
1
&&
replyVal2
!=
-
1
)
reply
.
addData
(
replyVal2
);
else
if
(
num
==
2
&&
replyVal3
!=
-
1
)
reply
.
addData
(
replyVal3
);
else
reply
.
addData
(
replyVal
);
reply
.
addData
(
replyVal
);
}
else
else
reply
.
addData
(
reg
);
reply
.
addData
(
reg
);
}
}
...
@@ -239,14 +217,7 @@ ModbusRTU::mbErrCode MBSlave::readOutputRegisters(
...
@@ -239,14 +217,7 @@ ModbusRTU::mbErrCode MBSlave::readOutputRegisters(
for
(
;
num
<
query
.
count
;
num
++
,
reg
++
)
for
(
;
num
<
query
.
count
;
num
++
,
reg
++
)
{
{
if
(
replyVal
!=
-
1
)
if
(
replyVal
!=
-
1
)
{
if
(
num
==
1
&&
replyVal2
!=
-
1
)
reply
.
addData
(
replyVal2
);
else
if
(
num
==
2
&&
replyVal3
!=
-
1
)
reply
.
addData
(
replyVal3
);
else
reply
.
addData
(
replyVal
);
reply
.
addData
(
replyVal
);
}
else
else
reply
.
addData
(
reg
);
reply
.
addData
(
reg
);
}
}
...
@@ -473,68 +444,3 @@ ModbusRTU::mbErrCode MBSlave::diagnostics( ModbusRTU::DiagnosticMessage& query,
...
@@ -473,68 +444,3 @@ ModbusRTU::mbErrCode MBSlave::diagnostics( ModbusRTU::DiagnosticMessage& query,
return
ModbusRTU
::
erOperationFailed
;
return
ModbusRTU
::
erOperationFailed
;
}
}
// -------------------------------------------------------------------------
// -------------------------------------------------------------------------
ModbusRTU
::
mbErrCode
MBSlave
::
read4314
(
ModbusRTU
::
MEIMessageRDI
&
query
,
ModbusRTU
::
MEIMessageRetRDI
&
reply
)
{
if
(
verbose
)
cout
<<
"(read4314): "
<<
query
<<
endl
;
if
(
query
.
devID
<=
rdevMinNum
||
query
.
devID
>=
rdevMaxNum
)
return
erOperationFailed
;
if
(
query
.
objID
==
rdiVendorName
)
{
reply
.
mf
=
0xFF
;
reply
.
conformity
=
rdevBasicDevice
;
reply
.
addData
(
query
.
objID
,
"etersoft"
);
// reply.addData(rdiProductCode, PACKAGE_NAME);
// reply.addData(rdiMajorMinorRevision,PACKAGE_VERSION);
return
erNoError
;
}
else
if
(
query
.
objID
==
rdiProductCode
)
{
reply
.
mf
=
0xFF
;
reply
.
conformity
=
rdevBasicDevice
;
reply
.
addData
(
query
.
objID
,
PACKAGE_NAME
);
return
erNoError
;
}
else
if
(
query
.
objID
==
rdiMajorMinorRevision
)
{
reply
.
mf
=
0xFF
;
reply
.
conformity
=
rdevBasicDevice
;
reply
.
addData
(
query
.
objID
,
PACKAGE_VERSION
);
return
erNoError
;
}
else
if
(
query
.
objID
==
rdiVendorURL
)
{
reply
.
mf
=
0xFF
;
reply
.
conformity
=
rdevRegularDevice
;
reply
.
addData
(
query
.
objID
,
PACKAGE_URL
);
return
erNoError
;
}
else
if
(
query
.
objID
==
rdiProductName
)
{
reply
.
mf
=
0xFF
;
reply
.
conformity
=
rdevRegularDevice
;
reply
.
addData
(
query
.
objID
,
PACKAGE_NAME
);
return
erNoError
;
}
else
if
(
query
.
objID
==
rdiModelName
)
{
reply
.
mf
=
0xFF
;
reply
.
conformity
=
rdevRegularDevice
;
reply
.
addData
(
query
.
objID
,
"MBSlaveEcho"
);
return
erNoError
;
}
else
if
(
query
.
objID
==
rdiUserApplicationName
)
{
reply
.
mf
=
0xFF
;
reply
.
conformity
=
rdevRegularDevice
;
reply
.
addData
(
query
.
objID
,
"uniset-mbrtuslave-echo"
);
return
erNoError
;
}
return
ModbusRTU
::
erBadDataAddress
;
}
// -------------------------------------------------------------------------
Utilities/MBTester/mbrtutester.cc
View file @
7a8e66a6
...
@@ -20,7 +20,6 @@ static struct option longopts[] = {
...
@@ -20,7 +20,6 @@ static struct option longopts[] = {
{
"write0F"
,
required_argument
,
0
,
'm'
},
{
"write0F"
,
required_argument
,
0
,
'm'
},
{
"write10"
,
required_argument
,
0
,
'w'
},
{
"write10"
,
required_argument
,
0
,
'w'
},
{
"diag08"
,
required_argument
,
0
,
'o'
},
{
"diag08"
,
required_argument
,
0
,
'o'
},
{
"read4314"
,
required_argument
,
0
,
'e'
},
// { "readfile14", required_argument, 0, 'g' },
// { "readfile14", required_argument, 0, 'g' },
// { "writefile15", required_argument, 0, 'p' },
// { "writefile15", required_argument, 0, 'p' },
{
"filetransfer66"
,
required_argument
,
0
,
'u'
},
{
"filetransfer66"
,
required_argument
,
0
,
'u'
},
...
@@ -32,7 +31,7 @@ static struct option longopts[] = {
...
@@ -32,7 +31,7 @@ static struct option longopts[] = {
{
"myaddr"
,
required_argument
,
0
,
'a'
},
{
"myaddr"
,
required_argument
,
0
,
'a'
},
{
"speed"
,
required_argument
,
0
,
's'
},
{
"speed"
,
required_argument
,
0
,
's'
},
{
"use485F"
,
no_argument
,
0
,
'y'
},
{
"use485F"
,
no_argument
,
0
,
'y'
},
{
"num-cycles"
,
required_argument
,
0
,
'
l
'
},
{
"num-cycles"
,
required_argument
,
0
,
'
q
'
},
{
NULL
,
0
,
0
,
0
}
{
NULL
,
0
,
0
,
0
}
};
};
// --------------------------------------------------------------------------
// --------------------------------------------------------------------------
...
@@ -48,7 +47,6 @@ static void print_help()
...
@@ -48,7 +47,6 @@ static void print_help()
printf
(
"[--read03] slaveaddr reg count - read from reg (from slaveaddr). Default: count=1
\n
"
);
printf
(
"[--read03] slaveaddr reg count - read from reg (from slaveaddr). Default: count=1
\n
"
);
printf
(
"[--read04] slaveaddr reg count - read from reg (from slaveaddr). Default: count=1
\n
"
);
printf
(
"[--read04] slaveaddr reg count - read from reg (from slaveaddr). Default: count=1
\n
"
);
printf
(
"[--diag08] slaveaddr subfunc [dat] - diagnostics request
\n
"
);
printf
(
"[--diag08] slaveaddr subfunc [dat] - diagnostics request
\n
"
);
printf
(
"[--read4314] slaveaddr devID objID - (0x2B/0x0E): read device identification (devID=[1...4], objID=[0..255])
\n
"
);
// printf("[--readfile14] slaveaddr fileID - read file from slaveaddr).\n");
// printf("[--readfile14] slaveaddr fileID - read file from slaveaddr).\n");
// printf("[--writefile15] slaveaddr id filename - write file to slaveaddr).\n");
// printf("[--writefile15] slaveaddr id filename - write file to slaveaddr).\n");
printf
(
"[--filetransfer66] slaveaddr fileID [filename] - get file from slaveaddr. Default save to 'fileID.transfer'
\n
"
);
printf
(
"[--filetransfer66] slaveaddr fileID [filename] - get file from slaveaddr. Default save to 'fileID.transfer'
\n
"
);
...
@@ -58,7 +56,7 @@ static void print_help()
...
@@ -58,7 +56,7 @@ static void print_help()
printf
(
" fn - function of test [0x01,0x02,0x03,0x04]. Default: 0x04
\n
"
);
printf
(
" fn - function of test [0x01,0x02,0x03,0x04]. Default: 0x04
\n
"
);
printf
(
"[--autodetect-slave] [beg end reg fn] - find slave
\n
"
);
printf
(
"[--autodetect-slave] [beg end reg fn] - find slave
\n
"
);
printf
(
" beg - start addres Default: 0
\n
"
);
printf
(
" beg - start addres Default: 0
\n
"
);
printf
(
" end - end addres Default: 25
4
\n
"
);
printf
(
" end - end addres Default: 25
5
\n
"
);
printf
(
" reg - register of test. Default: 0
\n
"
);
printf
(
" reg - register of test. Default: 0
\n
"
);
printf
(
" fn - function of test [0x01,0x02,0x03,0x04]. Default: 0x04
\n
"
);
printf
(
" fn - function of test [0x01,0x02,0x03,0x04]. Default: 0x04
\n
"
);
printf
(
"[-y|--use485F] - use RS485 Fastwel.
\n
"
);
printf
(
"[-y|--use485F] - use RS485 Fastwel.
\n
"
);
...
@@ -77,8 +75,6 @@ enum Command
...
@@ -77,8 +75,6 @@ enum Command
cmdRead02
,
cmdRead02
,
cmdRead03
,
cmdRead03
,
cmdRead04
,
cmdRead04
,
cmdRead43_13
,
cmdRead43_14
,
cmdWrite05
,
cmdWrite05
,
cmdWrite06
,
cmdWrite06
,
cmdWrite0F
,
cmdWrite0F
,
...
@@ -109,7 +105,7 @@ int main( int argc, char **argv )
...
@@ -109,7 +105,7 @@ int main( int argc, char **argv )
ModbusRTU
::
ModbusAddr
slaveaddr
=
0x00
;
ModbusRTU
::
ModbusAddr
slaveaddr
=
0x00
;
ModbusRTU
::
SlaveFunctionCode
fn
=
ModbusRTU
::
fnReadInputRegisters
;
ModbusRTU
::
SlaveFunctionCode
fn
=
ModbusRTU
::
fnReadInputRegisters
;
ModbusRTU
::
ModbusAddr
beg
=
0
;
ModbusRTU
::
ModbusAddr
beg
=
0
;
ModbusRTU
::
ModbusAddr
end
=
25
4
;
ModbusRTU
::
ModbusAddr
end
=
25
5
;
ModbusRTU
::
DiagnosticsSubFunction
subfunc
=
ModbusRTU
::
subEcho
;
ModbusRTU
::
DiagnosticsSubFunction
subfunc
=
ModbusRTU
::
subEcho
;
ModbusRTU
::
ModbusData
dat
=
0
;
ModbusRTU
::
ModbusData
dat
=
0
;
int
tout
=
2000
;
int
tout
=
2000
;
...
@@ -117,12 +113,10 @@ int main( int argc, char **argv )
...
@@ -117,12 +113,10 @@ int main( int argc, char **argv )
string
tofile
(
""
);
string
tofile
(
""
);
int
use485
=
0
;
int
use485
=
0
;
int
ncycles
=
-
1
;
int
ncycles
=
-
1
;
ModbusRTU
::
ModbusByte
devID
=
0
;
ModbusRTU
::
ModbusByte
objID
=
0
;
try
try
{
{
while
(
(
opt
=
getopt_long
(
argc
,
argv
,
"hva:w:z:m:r:x:c:b:d:s:t:qn:u:yl:t:o:
e:"
,
longopts
,
&
optindex
))
!=
-
1
)
while
(
(
opt
=
getopt_long
(
argc
,
argv
,
"hva:w:z:m:r:x:c:b:d:s:t:qn:u:yl:t:o:
"
,
longopts
,
&
optindex
))
!=
-
1
)
{
{
switch
(
opt
)
switch
(
opt
)
{
{
...
@@ -154,7 +148,7 @@ int main( int argc, char **argv )
...
@@ -154,7 +148,7 @@ int main( int argc, char **argv )
reg
=
ModbusRTU
::
str2mbData
(
argv
[
optind
]);
reg
=
ModbusRTU
::
str2mbData
(
argv
[
optind
]);
if
(
checkArg
(
optind
+
1
,
argc
,
argv
)
)
if
(
checkArg
(
optind
+
1
,
argc
,
argv
)
)
count
=
ModbusRTU
::
str2mbData
(
argv
[
optind
+
1
]);
dat
=
uni_atoi
(
argv
[
optind
+
1
]);
break
;
break
;
case
'o'
:
case
'o'
:
...
@@ -173,26 +167,7 @@ int main( int argc, char **argv )
...
@@ -173,26 +167,7 @@ int main( int argc, char **argv )
if
(
checkArg
(
optind
+
1
,
argc
,
argv
)
)
if
(
checkArg
(
optind
+
1
,
argc
,
argv
)
)
dat
=
uni_atoi
(
argv
[
optind
+
1
]);
dat
=
uni_atoi
(
argv
[
optind
+
1
]);
break
;
break
;
case
'e'
:
{
if
(
cmd
==
cmdNOP
)
cmd
=
cmdRead43_14
;
slaveaddr
=
ModbusRTU
::
str2mbAddr
(
optarg
);
if
(
optind
>
argc
)
{
cerr
<<
"read command error: bad or no arguments..."
<<
endl
;
return
1
;
}
if
(
checkArg
(
optind
,
argc
,
argv
)
)
devID
=
ModbusRTU
::
str2mbData
(
argv
[
optind
]);
if
(
checkArg
(
optind
+
1
,
argc
,
argv
)
)
objID
=
uni_atoi
(
argv
[
optind
+
1
]);
}
break
;
case
'f'
:
case
'f'
:
cmd
=
cmdWrite05
;
cmd
=
cmdWrite05
;
case
'z'
:
case
'z'
:
...
@@ -484,24 +459,6 @@ int main( int argc, char **argv )
...
@@ -484,24 +459,6 @@ int main( int argc, char **argv )
}
}
break
;
break
;
case
cmdRead43_14
:
{
if
(
verb
)
{
cout
<<
"read4314: slaveaddr="
<<
ModbusRTU
::
addr2str
(
slaveaddr
)
<<
" devID="
<<
ModbusRTU
::
dat2str
(
devID
)
<<
" objID="
<<
ModbusRTU
::
dat2str
(
objID
)
<<
endl
;
}
ModbusRTU
::
MEIMessageRetRDI
ret
=
mb
.
read4314
(
slaveaddr
,
devID
,
objID
);
if
(
verb
)
cout
<<
"(reply): "
<<
ret
<<
endl
;
else
cout
<<
"(reply): devID='"
<<
(
int
)
ret
.
devID
<<
"' objNum='"
<<
(
int
)
ret
.
objNum
<<
"'"
<<
endl
<<
ret
.
dlist
<<
endl
;
}
break
;
case
cmdWrite05
:
case
cmdWrite05
:
{
{
if
(
verb
)
if
(
verb
)
...
@@ -676,7 +633,7 @@ int main( int argc, char **argv )
...
@@ -676,7 +633,7 @@ int main( int argc, char **argv )
catch
(
ModbusRTU
::
mbException
&
ex
)
catch
(
ModbusRTU
::
mbException
&
ex
)
{
{
if
(
ex
.
err
!=
ModbusRTU
::
erTimeOut
)
if
(
ex
.
err
!=
ModbusRTU
::
erTimeOut
)
throw
;
throw
ex
;
cout
<<
"timeout..."
<<
endl
;
cout
<<
"timeout..."
<<
endl
;
}
}
...
...
Utilities/MBTester/mbtcptester.cc
View file @
7a8e66a6
...
@@ -14,8 +14,6 @@ static struct option longopts[] = {
...
@@ -14,8 +14,6 @@ static struct option longopts[] = {
{
"read02"
,
required_argument
,
0
,
'b'
},
{
"read02"
,
required_argument
,
0
,
'b'
},
{
"read03"
,
required_argument
,
0
,
'r'
},
{
"read03"
,
required_argument
,
0
,
'r'
},
{
"read04"
,
required_argument
,
0
,
'x'
},
{
"read04"
,
required_argument
,
0
,
'x'
},
// { "read4313", required_argument, 0, 'u' },
{
"read4314"
,
required_argument
,
0
,
'e'
},
{
"write05"
,
required_argument
,
0
,
'f'
},
{
"write05"
,
required_argument
,
0
,
'f'
},
{
"write06"
,
required_argument
,
0
,
'z'
},
{
"write06"
,
required_argument
,
0
,
'z'
},
{
"write0F"
,
required_argument
,
0
,
'm'
},
{
"write0F"
,
required_argument
,
0
,
'm'
},
...
@@ -43,8 +41,6 @@ static void print_help()
...
@@ -43,8 +41,6 @@ static void print_help()
printf
(
"[--read03] slaveaddr reg count - read from reg (from slaveaddr). Default: count=1
\n
"
);
printf
(
"[--read03] slaveaddr reg count - read from reg (from slaveaddr). Default: count=1
\n
"
);
printf
(
"[--read04] slaveaddr reg count - read from reg (from slaveaddr). Default: count=1
\n
"
);
printf
(
"[--read04] slaveaddr reg count - read from reg (from slaveaddr). Default: count=1
\n
"
);
printf
(
"[--diag08] slaveaddr subfunc [dat] - diagnostics request
\n
"
);
printf
(
"[--diag08] slaveaddr subfunc [dat] - diagnostics request
\n
"
);
printf
(
"[--read4314] slaveaddr devID objID - (0x2B/0x0E): read device identification (devID=[1...4], objID=[0..254])
\n
"
);
// printf("[--read43-13] slaveaddr ... - (0x2B/0x0D): CANopen General Reference Request and Response PDU \n");
printf
(
"[-i|--iaddr] ip - Modbus server ip. Default: 127.0.0.1
\n
"
);
printf
(
"[-i|--iaddr] ip - Modbus server ip. Default: 127.0.0.1
\n
"
);
printf
(
"[-a|--myaddr] addr - Modbus address for master. Default: 0x01.
\n
"
);
printf
(
"[-a|--myaddr] addr - Modbus address for master. Default: 0x01.
\n
"
);
printf
(
"[-p|--port] port - Modbus server port. Default: 502.
\n
"
);
printf
(
"[-p|--port] port - Modbus server port. Default: 502.
\n
"
);
...
@@ -61,8 +57,6 @@ enum Command
...
@@ -61,8 +57,6 @@ enum Command
cmdRead02
,
cmdRead02
,
cmdRead03
,
cmdRead03
,
cmdRead04
,
cmdRead04
,
cmdRead43_13
,
cmdRead43_14
,
cmdWrite05
,
cmdWrite05
,
cmdWrite06
,
cmdWrite06
,
cmdWrite0F
,
cmdWrite0F
,
...
@@ -92,12 +86,10 @@ int main( int argc, char **argv )
...
@@ -92,12 +86,10 @@ int main( int argc, char **argv )
int
tout
=
2000
;
int
tout
=
2000
;
DebugStream
dlog
;
DebugStream
dlog
;
int
ncycles
=
-
1
;
int
ncycles
=
-
1
;
ModbusRTU
::
ModbusByte
devID
=
0
;
ModbusRTU
::
ModbusByte
objID
=
0
;
try
try
{
{
while
(
(
opt
=
getopt_long
(
argc
,
argv
,
"hva:w:z:r:x:c:b:d:s:t:p:i:ol:d:
e:u:"
,
longopts
,
&
optindex
))
!=
-
1
)
while
(
(
opt
=
getopt_long
(
argc
,
argv
,
"hva:w:z:r:x:c:b:d:s:t:p:i:ol:d:
"
,
longopts
,
&
optindex
))
!=
-
1
)
{
{
switch
(
opt
)
switch
(
opt
)
{
{
...
@@ -115,7 +107,7 @@ int main( int argc, char **argv )
...
@@ -115,7 +107,7 @@ int main( int argc, char **argv )
if
(
cmd
==
cmdNOP
)
if
(
cmd
==
cmdNOP
)
cmd
=
cmdRead03
;
cmd
=
cmdRead03
;
case
'x'
:
case
'x'
:
{
if
(
cmd
==
cmdNOP
)
if
(
cmd
==
cmdNOP
)
cmd
=
cmdRead04
;
cmd
=
cmdRead04
;
slaveaddr
=
ModbusRTU
::
str2mbAddr
(
optarg
);
slaveaddr
=
ModbusRTU
::
str2mbAddr
(
optarg
);
...
@@ -130,29 +122,8 @@ int main( int argc, char **argv )
...
@@ -130,29 +122,8 @@ int main( int argc, char **argv )
if
(
checkArg
(
optind
+
1
,
argc
,
argv
)
)
if
(
checkArg
(
optind
+
1
,
argc
,
argv
)
)
count
=
uni_atoi
(
argv
[
optind
+
1
]);
count
=
uni_atoi
(
argv
[
optind
+
1
]);
}
break
;
break
;
case
'e'
:
{
if
(
cmd
==
cmdNOP
)
cmd
=
cmdRead43_14
;
slaveaddr
=
ModbusRTU
::
str2mbAddr
(
optarg
);
if
(
optind
>
argc
)
{
cerr
<<
"read command error: bad or no arguments..."
<<
endl
;
return
1
;
}
if
(
checkArg
(
optind
,
argc
,
argv
)
)
devID
=
ModbusRTU
::
str2mbData
(
argv
[
optind
]);
if
(
checkArg
(
optind
+
1
,
argc
,
argv
)
)
objID
=
uni_atoi
(
argv
[
optind
+
1
]);
}
break
;
case
'f'
:
case
'f'
:
cmd
=
cmdWrite05
;
cmd
=
cmdWrite05
;
case
'z'
:
case
'z'
:
...
@@ -251,7 +222,7 @@ int main( int argc, char **argv )
...
@@ -251,7 +222,7 @@ int main( int argc, char **argv )
if
(
verb
)
if
(
verb
)
{
{
cout
<<
"(init): ip="
<<
iaddr
<<
":"
<<
port
cout
<<
"(init): ip="
<<
iaddr
<<
":"
<<
port
<<
" mbaddr="
<<
ModbusRTU
::
addr2str
(
myaddr
)
<<
ModbusRTU
::
addr2str
(
myaddr
)
<<
" timeout="
<<
tout
<<
" msec "
<<
" timeout="
<<
tout
<<
" msec "
<<
endl
;
<<
endl
;
...
@@ -383,24 +354,6 @@ int main( int argc, char **argv )
...
@@ -383,24 +354,6 @@ int main( int argc, char **argv )
}
}
break
;
break
;
case
cmdRead43_14
:
{
if
(
verb
)
{
cout
<<
"read4314: slaveaddr="
<<
ModbusRTU
::
addr2str
(
slaveaddr
)
<<
" devID="
<<
ModbusRTU
::
dat2str
(
devID
)
<<
" objID="
<<
ModbusRTU
::
dat2str
(
objID
)
<<
endl
;
}
ModbusRTU
::
MEIMessageRetRDI
ret
=
mb
.
read4314
(
slaveaddr
,
devID
,
objID
);
if
(
verb
)
cout
<<
"(reply): "
<<
ret
<<
endl
;
else
cout
<<
"(reply): devID='"
<<
(
int
)
ret
.
devID
<<
"' objNum='"
<<
(
int
)
ret
.
objNum
<<
"'"
<<
endl
<<
ret
.
dlist
<<
endl
;
}
break
;
case
cmdWrite05
:
case
cmdWrite05
:
{
{
if
(
verb
)
if
(
verb
)
...
@@ -507,7 +460,7 @@ int main( int argc, char **argv )
...
@@ -507,7 +460,7 @@ int main( int argc, char **argv )
catch
(
ModbusRTU
::
mbException
&
ex
)
catch
(
ModbusRTU
::
mbException
&
ex
)
{
{
if
(
ex
.
err
!=
ModbusRTU
::
erTimeOut
)
if
(
ex
.
err
!=
ModbusRTU
::
erTimeOut
)
throw
;
throw
ex
;
cout
<<
"timeout..."
<<
endl
;
cout
<<
"timeout..."
<<
endl
;
}
}
...
...
conf/libuniset.spec
View file @
7a8e66a6
...
@@ -3,7 +3,7 @@
...
@@ -3,7 +3,7 @@
Name: libuniset
Name: libuniset
Version: 1.0
Version: 1.0
Release: alt5
5
Release: alt5
6
Summary: UniSet - library for building distributed industrial control systems
Summary: UniSet - library for building distributed industrial control systems
License: GPL
License: GPL
Group: Development/C++
Group: Development/C++
...
@@ -212,6 +212,9 @@ rm -f %buildroot%_libdir/*.la
...
@@ -212,6 +212,9 @@ rm -f %buildroot%_libdir/*.la
%changelog
%changelog
* Sat Nov 26 2011 Pavel Vainerman <pv@altlinux.ru> 1.0-alt56
- (modbus): fixed bug (again) in ModbusSlave::readInputStatus(0x02)
* Sat Nov 26 2011 Pavel Vainerman <pv@altlinux.ru> 1.0-alt55
* Sat Nov 26 2011 Pavel Vainerman <pv@altlinux.ru> 1.0-alt55
- (modbus): fixed bug in ModbusSlave::readInputStatus(0x02)
- (modbus): fixed bug in ModbusSlave::readInputStatus(0x02)
...
...
extensions/ModbusSlave/MBSlave.cc
View file @
7a8e66a6
...
@@ -125,7 +125,9 @@ prefix(prefix)
...
@@ -125,7 +125,9 @@ prefix(prefix)
if
(
findArgParam
(
"--"
+
prefix
+
"-allow-setdatetime"
,
conf
->
getArgc
(),
conf
->
getArgv
())
!=-
1
)
if
(
findArgParam
(
"--"
+
prefix
+
"-allow-setdatetime"
,
conf
->
getArgc
(),
conf
->
getArgv
())
!=-
1
)
mbslot
->
connectSetDateTime
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
setDateTime
)
);
mbslot
->
connectSetDateTime
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
setDateTime
)
);
mbslot
->
connectDiagnostics
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
diagnostics
)
);
mbslot
->
connectFileTransfer
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
fileTransfer
)
);
mbslot
->
connectFileTransfer
(
sigc
::
mem_fun
(
this
,
&
MBSlave
::
fileTransfer
)
);
// mbslot->connectJournalCommand( sigc::mem_fun(this, &MBSlave::journalCommand) );
// mbslot->connectJournalCommand( sigc::mem_fun(this, &MBSlave::journalCommand) );
// mbslot->connectRemoteService( sigc::mem_fun(this, &MBSlave::remoteService) );
// mbslot->connectRemoteService( sigc::mem_fun(this, &MBSlave::remoteService) );
// -------------------------------
// -------------------------------
...
@@ -608,7 +610,31 @@ void MBSlave::sensorInfo( UniSetTypes::SensorMessage* sm )
...
@@ -608,7 +610,31 @@ void MBSlave::sensorInfo( UniSetTypes::SensorMessage* sm )
uniset_spin_lock
lock
(
p
->
val_lock
);
uniset_spin_lock
lock
(
p
->
val_lock
);
p
->
value
=
sm
->
value
;
p
->
value
=
sm
->
value
;
}
}
break
;
int
sz
=
VTypes
::
wsize
(
p
->
vtype
);
if
(
sz
<
1
)
return
;
// если размер больше одного слова
// то надо обновить значение "везде"
// они если "всё верно инициализировано" идут подряд
int
i
=
0
;
for
(
;
i
<
sz
&&
it
!=
iomap
.
end
();
i
++
,
it
++
)
{
p
=
&
it
->
second
;
if
(
p
->
si
.
id
==
sm
->
id
)
p
->
value
=
sm
->
value
;
}
if
(
dlog
.
debugging
(
Debug
::
CRIT
)
)
{
// вообще этого не может случиться
// потому-что корректность проверяется при загрузке
if
(
i
!=
sz
)
dlog
[
Debug
::
CRIT
]
<<
myname
<<
"(sensorInfo): update failed for sid="
<<
sm
->
id
<<
" (i="
<<
i
<<
" sz="
<<
sz
<<
")"
<<
endl
;
}
return
;
}
}
}
}
}
}
...
@@ -889,7 +915,12 @@ ModbusRTU::mbErrCode MBSlave::writeOutputSingleRegister( ModbusRTU::WriteSingleO
...
@@ -889,7 +915,12 @@ ModbusRTU::mbErrCode MBSlave::writeOutputSingleRegister( ModbusRTU::WriteSingleO
// -------------------------------------------------------------------------
// -------------------------------------------------------------------------
ModbusRTU
::
mbErrCode
MBSlave
::
much_real_write
(
ModbusRTU
::
ModbusData
reg
,
ModbusRTU
::
ModbusData
*
dat
,
ModbusRTU
::
mbErrCode
MBSlave
::
much_real_write
(
ModbusRTU
::
ModbusData
reg
,
ModbusRTU
::
ModbusData
*
dat
,
int
count
)
int
count
)
{
{
if
(
dlog
.
debugging
(
Debug
::
INFO
)
)
{
dlog
[
Debug
::
INFO
]
<<
myname
<<
"(much_real_write): read mbID="
<<
ModbusRTU
::
dat2str
(
reg
)
<<
" count="
<<
count
<<
endl
;
}
int
i
=
0
;
int
i
=
0
;
IOMap
::
iterator
it
=
iomap
.
end
();
IOMap
::
iterator
it
=
iomap
.
end
();
for
(
;
i
<
count
;
i
++
)
for
(
;
i
<
count
;
i
++
)
...
@@ -1053,7 +1084,7 @@ ModbusRTU::mbErrCode MBSlave::much_real_read( ModbusRTU::ModbusData reg, ModbusR
...
@@ -1053,7 +1084,7 @@ ModbusRTU::mbErrCode MBSlave::much_real_read( ModbusRTU::ModbusData reg, ModbusR
{
{
if
(
dlog
.
debugging
(
Debug
::
INFO
)
)
if
(
dlog
.
debugging
(
Debug
::
INFO
)
)
{
{
dlog
[
Debug
::
INFO
]
<<
myname
<<
"(mu
s
h_real_read): read mbID="
dlog
[
Debug
::
INFO
]
<<
myname
<<
"(mu
c
h_real_read): read mbID="
<<
ModbusRTU
::
dat2str
(
reg
)
<<
" count="
<<
count
<<
endl
;
<<
ModbusRTU
::
dat2str
(
reg
)
<<
" count="
<<
count
<<
endl
;
}
}
...
@@ -1297,10 +1328,9 @@ ModbusRTU::mbErrCode MBSlave::readInputStatus( ReadInputStatusMessage& query,
...
@@ -1297,10 +1328,9 @@ ModbusRTU::mbErrCode MBSlave::readInputStatus( ReadInputStatusMessage& query,
ModbusRTU
::
ModbusData
d
=
0
;
ModbusRTU
::
ModbusData
d
=
0
;
ModbusRTU
::
mbErrCode
ret
=
real_read
(
query
.
start
,
d
);
ModbusRTU
::
mbErrCode
ret
=
real_read
(
query
.
start
,
d
);
if
(
ret
==
ModbusRTU
::
erNoError
)
if
(
ret
==
ModbusRTU
::
erNoError
)
reply
.
addData
(
d
);
reply
.
setBit
(
0
,
0
,
d
);
else
else
reply
.
addData
(
0
);
reply
.
setBit
(
0
,
0
,
0
);
pingOK
=
true
;
pingOK
=
true
;
return
ret
;
return
ret
;
...
@@ -1308,29 +1338,15 @@ ModbusRTU::mbErrCode MBSlave::readInputStatus( ReadInputStatusMessage& query,
...
@@ -1308,29 +1338,15 @@ ModbusRTU::mbErrCode MBSlave::readInputStatus( ReadInputStatusMessage& query,
// Фомирование ответа:
// Фомирование ответа:
much_real_read
(
query
.
start
,
buf
,
query
.
count
);
much_real_read
(
query
.
start
,
buf
,
query
.
count
);
for
(
int
i
=
0
;
i
<
query
.
count
;
i
++
)
int
bnum
=
0
;
reply
.
addData
(
buf
[
i
]
);
int
i
=
0
;
/*
while
(
i
<
query
.
count
)
int num=0; // добавленное количество данных
ModbusRTU::ModbusData d = 0;
ModbusRTU::ModbusData reg = query.start;
for( ; num<query.count; num++, reg++ )
{
{
ModbusRTU::mbErrCode ret = real_read(reg,d);
if( ret == ModbusRTU::erNoError )
reply.addData(d);
else
reply
.
addData
(
0
);
reply
.
addData
(
0
);
for
(
int
nbit
=
0
;
nbit
<
BitsPerByte
&&
i
<
query
.
count
;
nbit
++
,
i
++
)
reply
.
setBit
(
bnum
,
nbit
,
buf
[
i
]);
bnum
++
;
}
}
*/
// Если мы в начале проверили, что запрос входит в разрешёный диапазон
// то теоретически этой ситуации возникнуть не может...
// if( reply.bcnt < query.count )
// {
// dlog[Debug::WARN] << myname
// << "(readInputStatus): query.count=" << query.count
// << " > reply.count=" << reply.count << endl;
// }
pingOK
=
true
;
pingOK
=
true
;
return
ModbusRTU
::
erNoError
;
return
ModbusRTU
::
erNoError
;
...
@@ -1375,3 +1391,46 @@ ModbusRTU::mbErrCode MBSlave::forceSingleCoil( ModbusRTU::ForceSingleCoilMessage
...
@@ -1375,3 +1391,46 @@ ModbusRTU::mbErrCode MBSlave::forceSingleCoil( ModbusRTU::ForceSingleCoilMessage
return
ModbusRTU
::
erOperationFailed
;
return
ModbusRTU
::
erOperationFailed
;
}
}
// -------------------------------------------------------------------------
// -------------------------------------------------------------------------
ModbusRTU
::
mbErrCode
MBSlave
::
diagnostics
(
ModbusRTU
::
DiagnosticMessage
&
query
,
ModbusRTU
::
DiagnosticRetMessage
&
reply
)
{
if
(
query
.
subf
==
ModbusRTU
::
subEcho
)
{
reply
=
query
;
return
ModbusRTU
::
erNoError
;
}
if
(
query
.
subf
==
ModbusRTU
::
dgBusErrCount
)
{
reply
=
query
;
reply
.
data
[
0
]
=
errmap
[
ModbusRTU
::
erBadCheckSum
];
return
ModbusRTU
::
erNoError
;
}
if
(
query
.
subf
==
ModbusRTU
::
dgMsgSlaveCount
||
query
.
subf
==
ModbusRTU
::
dgBusMsgCount
)
{
reply
=
query
;
reply
.
data
[
0
]
=
askCount
;
return
ModbusRTU
::
erNoError
;
}
if
(
query
.
subf
==
ModbusRTU
::
dgSlaveNAKCount
)
{
reply
=
query
;
reply
.
data
[
0
]
=
errmap
[
erOperationFailed
];
return
ModbusRTU
::
erNoError
;
}
if
(
query
.
subf
==
ModbusRTU
::
dgClearCounters
)
{
askCount
=
0
;
errmap
[
erOperationFailed
]
=
0
;
errmap
[
ModbusRTU
::
erBadCheckSum
]
=
0
;
// другие счётчики пока не сбрасываем..
reply
=
query
;
return
ModbusRTU
::
erNoError
;
}
return
ModbusRTU
::
erOperationFailed
;
}
// -------------------------------------------------------------------------
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment