Skip to content

osie
osie
Commit 40ca6173 authored by Ivan Tyagov's avatar Ivan Tyagov
Browse files
Options

Use provided by user from CLI list of MOD-IOs.

parent 13c80fc6
Hide whitespace changes
Inline Side-by-side
Showing with 27 additions and 20 deletions
coupler/opc-ua-server/server.c
View file @ 40ca6173
...@@ -20,8 +20,7 @@ uint8_t I2C_0_RELAYS_STATE = 0; // state of 4 relays at I2C slave 0 ...@@ -20,8 +20,7 @@ uint8_t I2C_0_RELAYS_STATE = 0; // state of 4 relays at I2C slave 0
uint8_t I2C_1_RELAYS_STATE = 0; // state of 4 relays at I2C slave 1 uint8_t I2C_1_RELAYS_STATE = 0; // state of 4 relays at I2C slave 1
// the default addresses of MOD-IOs // the default addresses of MOD-IOs
const int I2C_0_ADDR = 0x58; const int DEFAULT_I2C_0_ADDR = 0x58;
const int I2C_1_ADDR = 0x59;
// the list of attached I2C slaves // the list of attached I2C slaves
const int DEFAULT_I2C_SLAVE_ADDR = 0x58; const int DEFAULT_I2C_SLAVE_ADDR = 0x58;
...@@ -120,13 +119,14 @@ static void afterWriteTimeI2C0_0(UA_Server *server, ...@@ -120,13 +119,14 @@ static void afterWriteTimeI2C0_0(UA_Server *server,
const UA_NumericRange *range, const UA_DataValue *data) { const UA_NumericRange *range, const UA_DataValue *data) {
if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) { if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) {
UA_Int32 hrValue = *(UA_Int32 *)data->value.data; UA_Int32 hrValue = *(UA_Int32 *)data->value.data;
int addr = I2C_SLAVE_ADDR_LIST[0];
if (hrValue > 0){ if (hrValue > 0){
I2C_0_RELAYS_STATE |= 1UL << 0; I2C_0_RELAYS_STATE |= 1UL << 0;
setRelayState(I2C_0_RELAYS_STATE, I2C_0_ADDR); setRelayState(I2C_0_RELAYS_STATE, addr);
} }
else { else {
I2C_0_RELAYS_STATE &= ~(1UL << 0); I2C_0_RELAYS_STATE &= ~(1UL << 0);
setRelayState(I2C_0_RELAYS_STATE, I2C_0_ADDR); setRelayState(I2C_0_RELAYS_STATE, addr);
} }
} }
} }
...@@ -137,13 +137,14 @@ static void afterWriteTimeI2C0_1(UA_Server *server, ...@@ -137,13 +137,14 @@ static void afterWriteTimeI2C0_1(UA_Server *server,
const UA_NumericRange *range, const UA_DataValue *data) { const UA_NumericRange *range, const UA_DataValue *data) {
if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) { if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) {
UA_Int32 hrValue = *(UA_Int32 *)data->value.data; UA_Int32 hrValue = *(UA_Int32 *)data->value.data;
int addr = I2C_SLAVE_ADDR_LIST[0];
if (hrValue > 0){ if (hrValue > 0){
I2C_0_RELAYS_STATE |= 1UL << 1; I2C_0_RELAYS_STATE |= 1UL << 1;
setRelayState(I2C_0_RELAYS_STATE, I2C_0_ADDR); setRelayState(I2C_0_RELAYS_STATE, addr);
} }
else { else {
I2C_0_RELAYS_STATE &= ~(1UL << 1); I2C_0_RELAYS_STATE &= ~(1UL << 1);
setRelayState(I2C_0_RELAYS_STATE, I2C_0_ADDR); setRelayState(I2C_0_RELAYS_STATE, addr);
} }
} }
} }
...@@ -154,13 +155,14 @@ static void afterWriteTimeI2C0_2(UA_Server *server, ...@@ -154,13 +155,14 @@ static void afterWriteTimeI2C0_2(UA_Server *server,
const UA_NumericRange *range, const UA_DataValue *data) { const UA_NumericRange *range, const UA_DataValue *data) {
if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) { if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) {
UA_Int32 hrValue = *(UA_Int32 *)data->value.data; UA_Int32 hrValue = *(UA_Int32 *)data->value.data;
int addr = I2C_SLAVE_ADDR_LIST[0];
if (hrValue > 0){ if (hrValue > 0){
I2C_0_RELAYS_STATE |= 1UL << 2; I2C_0_RELAYS_STATE |= 1UL << 2;
setRelayState(I2C_0_RELAYS_STATE, I2C_0_ADDR); setRelayState(I2C_0_RELAYS_STATE, addr);
} }
else { else {
I2C_0_RELAYS_STATE &= ~(1UL << 2); I2C_0_RELAYS_STATE &= ~(1UL << 2);
setRelayState(I2C_0_RELAYS_STATE, I2C_0_ADDR); setRelayState(I2C_0_RELAYS_STATE, addr);
} }
} }
} }
...@@ -171,13 +173,14 @@ static void afterWriteTimeI2C0_3(UA_Server *server, ...@@ -171,13 +173,14 @@ static void afterWriteTimeI2C0_3(UA_Server *server,
const UA_NumericRange *range, const UA_DataValue *data) { const UA_NumericRange *range, const UA_DataValue *data) {
if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) { if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) {
UA_Int32 hrValue = *(UA_Int32 *)data->value.data; UA_Int32 hrValue = *(UA_Int32 *)data->value.data;
int addr = I2C_SLAVE_ADDR_LIST[0];
if (hrValue > 0){ if (hrValue > 0){
I2C_0_RELAYS_STATE |= 1UL << 3; I2C_0_RELAYS_STATE |= 1UL << 3;
setRelayState(I2C_0_RELAYS_STATE, I2C_0_ADDR); setRelayState(I2C_0_RELAYS_STATE, addr);
} }
else { else {
I2C_0_RELAYS_STATE &= ~(1UL << 3); I2C_0_RELAYS_STATE &= ~(1UL << 3);
setRelayState(I2C_0_RELAYS_STATE, I2C_0_ADDR); setRelayState(I2C_0_RELAYS_STATE, addr);
} }
} }
} }
...@@ -190,13 +193,14 @@ static void afterWriteTimeI2C1_0(UA_Server *server, ...@@ -190,13 +193,14 @@ static void afterWriteTimeI2C1_0(UA_Server *server,
const UA_NumericRange *range, const UA_DataValue *data) { const UA_NumericRange *range, const UA_DataValue *data) {
if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) { if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) {
UA_Int32 hrValue = *(UA_Int32 *)data->value.data; UA_Int32 hrValue = *(UA_Int32 *)data->value.data;
int addr = I2C_SLAVE_ADDR_LIST[1];
if (hrValue > 0){ if (hrValue > 0){
I2C_1_RELAYS_STATE |= 1UL << 0; I2C_1_RELAYS_STATE |= 1UL << 0;
setRelayState(I2C_1_RELAYS_STATE, I2C_1_ADDR); setRelayState(I2C_1_RELAYS_STATE, addr);
} }
else { else {
I2C_1_RELAYS_STATE &= ~(1UL << 0); I2C_1_RELAYS_STATE &= ~(1UL << 0);
setRelayState(I2C_1_RELAYS_STATE, I2C_1_ADDR); setRelayState(I2C_1_RELAYS_STATE, addr);
} }
} }
} }
...@@ -207,13 +211,14 @@ static void afterWriteTimeI2C1_1(UA_Server *server, ...@@ -207,13 +211,14 @@ static void afterWriteTimeI2C1_1(UA_Server *server,
const UA_NumericRange *range, const UA_DataValue *data) { const UA_NumericRange *range, const UA_DataValue *data) {
if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) { if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) {
UA_Int32 hrValue = *(UA_Int32 *)data->value.data; UA_Int32 hrValue = *(UA_Int32 *)data->value.data;
int addr = I2C_SLAVE_ADDR_LIST[1];
if (hrValue > 0){ if (hrValue > 0){
I2C_1_RELAYS_STATE |= 1UL << 1; I2C_1_RELAYS_STATE |= 1UL << 1;
setRelayState(I2C_1_RELAYS_STATE, I2C_1_ADDR); setRelayState(I2C_1_RELAYS_STATE, addr);
} }
else { else {
I2C_1_RELAYS_STATE &= ~(1UL << 1); I2C_1_RELAYS_STATE &= ~(1UL << 1);
setRelayState(I2C_1_RELAYS_STATE, I2C_1_ADDR); setRelayState(I2C_1_RELAYS_STATE, addr);
} }
} }
} }
...@@ -224,13 +229,14 @@ static void afterWriteTimeI2C1_2(UA_Server *server, ...@@ -224,13 +229,14 @@ static void afterWriteTimeI2C1_2(UA_Server *server,
const UA_NumericRange *range, const UA_DataValue *data) { const UA_NumericRange *range, const UA_DataValue *data) {
if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) { if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) {
UA_Int32 hrValue = *(UA_Int32 *)data->value.data; UA_Int32 hrValue = *(UA_Int32 *)data->value.data;
int addr = I2C_SLAVE_ADDR_LIST[1];
if (hrValue > 0){ if (hrValue > 0){
I2C_1_RELAYS_STATE |= 1UL << 2; I2C_1_RELAYS_STATE |= 1UL << 2;
setRelayState(I2C_1_RELAYS_STATE, I2C_1_ADDR); setRelayState(I2C_1_RELAYS_STATE, addr);
} }
else { else {
I2C_1_RELAYS_STATE &= ~(1UL << 2); I2C_1_RELAYS_STATE &= ~(1UL << 2);
setRelayState(I2C_1_RELAYS_STATE, I2C_1_ADDR); setRelayState(I2C_1_RELAYS_STATE, addr);
} }
} }
} }
...@@ -241,13 +247,14 @@ static void afterWriteTimeI2C1_3(UA_Server *server, ...@@ -241,13 +247,14 @@ static void afterWriteTimeI2C1_3(UA_Server *server,
const UA_NumericRange *range, const UA_DataValue *data) { const UA_NumericRange *range, const UA_DataValue *data) {
if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) { if (data->value.type == &UA_TYPES[UA_TYPES_INT32]) {
UA_Int32 hrValue = *(UA_Int32 *)data->value.data; UA_Int32 hrValue = *(UA_Int32 *)data->value.data;
int addr = I2C_SLAVE_ADDR_LIST[1];
if (hrValue > 0){ if (hrValue > 0){
I2C_1_RELAYS_STATE |= 1UL << 3; I2C_1_RELAYS_STATE |= 1UL << 3;
setRelayState(I2C_1_RELAYS_STATE, I2C_1_ADDR); setRelayState(I2C_1_RELAYS_STATE, addr);
} }
else { else {
I2C_1_RELAYS_STATE &= ~(1UL << 3); I2C_1_RELAYS_STATE &= ~(1UL << 3);
setRelayState(I2C_1_RELAYS_STATE, I2C_1_ADDR); setRelayState(I2C_1_RELAYS_STATE, addr);
} }
} }
} }
...@@ -352,8 +359,8 @@ int main(int argc, char **argv) { ...@@ -352,8 +359,8 @@ int main(int argc, char **argv) {
// if nothing specified on CLI set a default one // if nothing specified on CLI set a default one
if (argc<= 2){ if (argc<= 2){
I2C_SLAVE_ADDR_LIST[0] = I2C_0_ADDR; I2C_SLAVE_ADDR_LIST[0] = DEFAULT_I2C_0_ADDR;
printf("I2C_slave=0x%x\n", I2C_0_ADDR); printf("I2C_slave=0x%x\n", DEFAULT_I2C_0_ADDR);
} }
else { else {
// override list of I2C slaves addresses from CLI // override list of I2C slaves addresses from CLI
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7