195 lines
4.8 KiB
C
195 lines
4.8 KiB
C
//------------------------------------------------------------------------------
|
|
// Copyright (C) 2012, Robert Johansson, Raditex AB
|
|
// All rights reserved.
|
|
//
|
|
// rSCADA
|
|
// http://www.rSCADA.se
|
|
// info@rscada.se
|
|
//
|
|
//------------------------------------------------------------------------------
|
|
|
|
#include <string.h>
|
|
|
|
#include <stdio.h>
|
|
#include <mbus/mbus.h>
|
|
|
|
static int debug = 0;
|
|
|
|
//------------------------------------------------------------------------------
|
|
// Execution starts here:
|
|
//------------------------------------------------------------------------------
|
|
int
|
|
main(int argc, char **argv)
|
|
{
|
|
mbus_frame reply, request;
|
|
mbus_frame_data reply_data;
|
|
mbus_handle *handle = NULL;
|
|
|
|
char *host, *addr_str, matching_addr[16], *file = NULL;
|
|
long port;
|
|
int address, result;
|
|
FILE *fp = NULL;
|
|
size_t buff_len, len;
|
|
unsigned char raw_buff[4096], buff[4096];
|
|
|
|
memset((void *)&reply, 0, sizeof(mbus_frame));
|
|
memset((void *)&reply_data, 0, sizeof(mbus_frame_data));
|
|
|
|
if (argc == 4)
|
|
{
|
|
host = argv[1];
|
|
port = atol(argv[2]);
|
|
addr_str = argv[3];
|
|
debug = 0;
|
|
}
|
|
else if (argc == 5 && strcmp(argv[1], "-d") == 0)
|
|
{
|
|
host = argv[2];
|
|
port = atol(argv[3]);
|
|
addr_str = argv[4];
|
|
debug = 1;
|
|
}
|
|
else if (argc == 5)
|
|
{
|
|
host = argv[1];
|
|
port = atol(argv[2]);
|
|
addr_str = argv[3];
|
|
file = argv[4];
|
|
debug = 0;
|
|
}
|
|
else if (argc == 6 && strcmp(argv[1], "-d") == 0)
|
|
{
|
|
host = argv[2];
|
|
port = atol(argv[3]);
|
|
addr_str = argv[4];
|
|
file = argv[5];
|
|
debug = 1;
|
|
}
|
|
else
|
|
{
|
|
fprintf(stderr, "usage: %s [-d] host port mbus-address [file]\n", argv[0]);
|
|
fprintf(stderr, " optional flag -d for debug printout\n");
|
|
fprintf(stderr, " optional argument file for file. if omitted read from stdin\n");
|
|
return 0;
|
|
}
|
|
|
|
if ((port < 0) || (port > 0xFFFF))
|
|
{
|
|
fprintf(stderr, "Invalid port: %ld\n", port);
|
|
return 1;
|
|
}
|
|
|
|
if ((handle = mbus_context_tcp(host, port)) == NULL)
|
|
{
|
|
fprintf(stderr, "Could not initialize M-Bus context: %s\n", mbus_error_str());
|
|
return 1;
|
|
}
|
|
|
|
if (debug)
|
|
{
|
|
mbus_register_send_event(handle, &mbus_dump_send_event);
|
|
mbus_register_recv_event(handle, &mbus_dump_recv_event);
|
|
}
|
|
|
|
if (mbus_connect(handle) == -1)
|
|
{
|
|
fprintf(stderr, "Failed to setup connection to M-bus gateway\n%s\n", mbus_error_str());
|
|
return 1;
|
|
}
|
|
|
|
if (mbus_is_secondary_address(addr_str))
|
|
{
|
|
// secondary addressing
|
|
int ret;
|
|
|
|
ret = mbus_select_secondary_address(handle, addr_str);
|
|
|
|
if (ret == MBUS_PROBE_COLLISION)
|
|
{
|
|
fprintf(stderr, "%s: Error: The address mask [%s] matches more than one device.\n", __PRETTY_FUNCTION__, addr_str);
|
|
return 1;
|
|
}
|
|
else if (ret == MBUS_PROBE_NOTHING)
|
|
{
|
|
fprintf(stderr, "%s: Error: The selected secondary address does not match any device [%s].\n", __PRETTY_FUNCTION__, addr_str);
|
|
return 1;
|
|
}
|
|
else if (ret == MBUS_PROBE_ERROR)
|
|
{
|
|
fprintf(stderr, "%s: Error: Failed to select secondary address [%s].\n", __PRETTY_FUNCTION__, addr_str);
|
|
return 1;
|
|
}
|
|
address = MBUS_ADDRESS_NETWORK_LAYER;
|
|
}
|
|
else
|
|
{
|
|
// primary addressing
|
|
address = atoi(addr_str);
|
|
}
|
|
|
|
//
|
|
// read hex data from file or stdin
|
|
//
|
|
if (file != NULL)
|
|
{
|
|
if ((fp = fopen(file, "r")) == NULL)
|
|
{
|
|
fprintf(stderr, "%s: failed to open '%s'\n", __PRETTY_FUNCTION__, file);
|
|
return 1;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
fp = stdin;
|
|
}
|
|
|
|
memset(raw_buff, 0, sizeof(raw_buff));
|
|
len = fread(raw_buff, 1, sizeof(raw_buff), fp);
|
|
|
|
if (fp != stdin)
|
|
{
|
|
fclose(fp);
|
|
}
|
|
|
|
buff_len = mbus_hex2bin(buff,sizeof(buff),raw_buff,sizeof(raw_buff));
|
|
|
|
//
|
|
// attempt to parse the input data
|
|
//
|
|
result = mbus_parse(&request, buff, buff_len);
|
|
|
|
if (result < 0)
|
|
{
|
|
fprintf(stderr, "mbus_parse: %s\n", mbus_error_str());
|
|
return 1;
|
|
}
|
|
else if (result > 0)
|
|
{
|
|
fprintf(stderr, "mbus_parse: need %d more bytes\n", result);
|
|
return 1;
|
|
}
|
|
|
|
//
|
|
// send the request
|
|
//
|
|
if (mbus_send_frame(handle, &request) == -1)
|
|
{
|
|
fprintf(stderr, "Failed to send mbus frame: %s\n", mbus_error_str());
|
|
return 1;
|
|
}
|
|
|
|
//
|
|
// this should be option:
|
|
//
|
|
if (mbus_recv_frame(handle, &reply) != MBUS_RECV_RESULT_OK)
|
|
{
|
|
fprintf(stderr, "Failed to receive M-Bus response frame: %s\n", mbus_error_str());
|
|
return 1;
|
|
}
|
|
|
|
mbus_disconnect(handle);
|
|
mbus_context_free(handle);
|
|
return 0;
|
|
}
|
|
|