antonlyap/nut-debian
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
e7000fc01c
nut-debian/drivers/riello.c
Laurent Bigonville b18c8996f1 New upstream version 2.8.0
2022-07-10 09:23:45 +02:00

1027 lines
24 KiB
C
Raw Blame History

/*
* riello.c: driver core for Riello protocol based UPSes
*
* Documents describing the protocol implemented by this driver can be
* found online at:
*
* http://www.networkupstools.org/ups-protocols/riello/PSGPSER-0104.pdf
* http://www.networkupstools.org/ups-protocols/riello/PSSENTR-0100.pdf
*
* Copyright (C) 2012 - Elio Parisi <e.parisi@riello-ups.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*
* Reference of the derivative work: blazer driver
*/
#include <string.h>
#include <stdint.h>
#include "main.h"
#include "riello.h"
static uint8_t foundheader = 0;
uint16_t buf_ptr_length;
uint8_t wait_packet = 0;
uint8_t foundnak = 0;
uint8_t foundbadcrc = 0;
uint8_t commbyte;
uint8_t requestSENTR;
static unsigned char LAST_DATA[6];
uint16_t riello_calc_CRC(uint8_t type, uint8_t *buff, uint16_t size, uint8_t checksum)
{
uint16_t i;
uint16_t pom, CRC_Word;
CRC_Word = 0;
switch (type) {
case DEV_RIELLOSENTRY:
CRC_Word = 0;
if (size == 101) {
for (i=0; i<100; i++)
CRC_Word += buff[i];
}
else {
for (i=0; i<size; i++)
CRC_Word += buff[i];
}
break;
case DEV_RIELLOGPSER:
if (checksum) {
buff++;
size--;
CRC_Word = 0x554D;
while(size--) {
pom = (CRC_Word ^ *buff) & 0x00ff;
pom = (pom ^ (pom << 4)) & 0x00ff;
/* Thanks to &0xff above, pom is at most 255 --
* so shifted by 8 bits is still uint16_t range
*/
pom = (uint16_t)(pom << 8);
pom ^= (pom << 3);
pom ^= (pom >> 4);
CRC_Word = (CRC_Word >> 8) ^ pom;
buff++;
}
}
else {
CRC_Word = 0;
for (i=1; i<size; i++)
CRC_Word += buff[i];
}
break;
}
return(CRC_Word);
}
void riello_create_crc(uint8_t type, uint8_t *buff, uint16_t size, uint8_t checksum)
{
uint16_t CRC_Word;
CRC_Word = riello_calc_CRC(type, buff, size, checksum);
if (type == DEV_RIELLOGPSER) {
buff[size++] = (uint8_t) ((CRC_Word/4096)+0x30);
buff[size++] = (uint8_t) (((CRC_Word%4096)/256)+0x30);
buff[size++] = (uint8_t) ((((CRC_Word%4096)%256)/16)+0x30);
buff[size] = (uint8_t) ((((CRC_Word%4096)%256)%16)+0x30);
}
}
uint8_t riello_test_crc(uint8_t type, uint8_t *buff, uint16_t size, uint8_t checksum)
{
uint16_t suma, CRC_Word;
switch (type) {
case DEV_RIELLOSENTRY:
CRC_Word = riello_calc_CRC(type, buff, size-2, 0);
suma = buff[size-2] + buff[size-1]*256;
if (suma != CRC_Word)
return(1);
break;
case DEV_RIELLOGPSER:
CRC_Word = riello_calc_CRC(type, buff, size-5, checksum);
suma = (buff[size-5]-0x30)*4096;
suma += (buff[size-4]-0x30)*256;
suma += (buff[size-3]-0x30)*16;
suma += (buff[size-2]-0x30);
if (suma != CRC_Word)
return(1);
break;
}
return(0);
}
uint8_t riello_test_bit(uint8_t *basic_address, uint8_t bit)
{
uint8_t posuv, offset;
uint8_t var, value;
if (basic_address == NULL)
return(0);
posuv = bit/8;
offset = bit%8;
var = *(basic_address+posuv);
if (var & (1 << offset))
value = 1;
else
value = 0;
return(value);
}
uint8_t riello_prepare_gi(uint8_t* buffer)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'G';
buffer[4] = 'I';
buffer[5] = '0';
buffer[6] = '0';
buf_ptr = 7;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, 0);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_gn(uint8_t* buffer, uint8_t gpser_error_control)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'G';
buffer[4] = 'N';
buffer[5] = '0';
buffer[6] = '0';
buf_ptr = 7;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_rs(uint8_t* buffer, uint8_t gpser_error_control)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'R';
buffer[4] = 'S';
buffer[5] = '0';
buffer[6] = '0';
buf_ptr = 7;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_re(uint8_t* buffer, uint8_t gpser_error_control)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'R';
buffer[4] = 'E';
buffer[5] = '0';
buffer[6] = '0';
buf_ptr = 7;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_rc(uint8_t* buffer, uint8_t gpser_error_control)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'R';
buffer[4] = 'C';
buffer[5] = '0';
buffer[6] = '0';
buf_ptr = 7;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_cs(uint8_t* buffer, uint8_t gpser_error_control, uint16_t delay)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'C';
buffer[4] = 'S';
buffer[5] = '0';
buffer[6] = '4';
buffer[7] = (uint8_t) ((delay/4096)+0x30);
buffer[8] = (uint8_t) (((delay%4096)/256)+0x30);
buffer[9] = (uint8_t) ((((delay%4096)%256)/16)+0x30);
buffer[10] = (uint8_t) ((((delay%4096)%256)%16)+0x30);
buf_ptr = 11;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_cr(uint8_t* buffer, uint8_t gpser_error_control, uint16_t delay)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'C';
buffer[4] = 'R';
buffer[5] = '0';
buffer[6] = '8';
buffer[7] = '0';
buffer[8] = '0';
buffer[9] = '0';
buffer[10] = '0';
buffer[11] = (uint8_t) ((delay/4096)+0x30);
buffer[12] = (uint8_t) (((delay%4096)/256)+0x30);
buffer[13] = (uint8_t) ((((delay%4096)%256)/16)+0x30);
buffer[14] = (uint8_t) ((((delay%4096)%256)%16)+0x30);
buf_ptr = 15;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_cd(uint8_t* buffer, uint8_t gpser_error_control)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'C';
buffer[4] = 'D';
buffer[5] = '0';
buffer[6] = '0';
buf_ptr = 7;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_tp(uint8_t* buffer, uint8_t gpser_error_control)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'T';
buffer[4] = 'P';
buffer[5] = '0';
buffer[6] = '0';
buf_ptr = 7;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_tb(uint8_t* buffer, uint8_t gpser_error_control)
{
uint8_t buf_ptr;
buffer[0] = 0x2;
buffer[1] = 0x20;
buffer[2] = 0x22;
buffer[3] = 'T';
buffer[4] = 'B';
buffer[5] = '0';
buffer[6] = '3';
buffer[7] = '0';
buffer[8] = '0';
buffer[9] = '5';
buf_ptr = 10;
riello_create_crc(DEV_RIELLOGPSER, buffer, buf_ptr, gpser_error_control);
buf_ptr = buf_ptr+4;
buffer[buf_ptr++] = 0x3;
return buf_ptr;
}
uint8_t riello_prepare_shutsentr(uint8_t* buffer, uint16_t delay)
{
buffer[0] = 176;
buffer[1] = 6;
buffer[2] = (uint8_t)(delay % 256);
buffer[3] = delay / 256;
buffer[4] = buffer[0] + buffer[1] + buffer[2] + buffer[3];
return 5;
}
uint8_t riello_prepare_cancelsentr(uint8_t* buffer)
{
buffer[0] = 176;
buffer[1] = 5;
buffer[2] = 0;
buffer[3] = 0;
buffer[4] = buffer[0] + buffer[1] + buffer[2] + buffer[3];
return 5;
}
uint8_t riello_prepare_setrebsentr(uint8_t* buffer, uint16_t delay)
{
buffer[0] = 176;
buffer[1] = 2;
buffer[2] = (uint8_t)(delay % 256);
buffer[3] = delay / 256;
buffer[4] = buffer[0] + buffer[1] + buffer[2] + buffer[3];
return 5;
}
uint8_t riello_prepare_rebsentr(uint8_t* buffer, uint16_t delay)
{
buffer[0] = 176;
buffer[1] = 1;
buffer[2] = (uint8_t)(delay % 256);
buffer[3] = delay / 256;
buffer[4] = buffer[0] + buffer[1] + buffer[2] + buffer[3];
return 5;
}
uint8_t riello_prepare_tbsentr(uint8_t* buffer)
{
buffer[0] = 176;
buffer[1] = 4;
buffer[2] = 0;
buffer[3] = 0;
buffer[4] = buffer[0] + buffer[1] + buffer[2] + buffer[3];
return 5;
}
void riello_parse_gi(uint8_t* buffer, TRielloData* data)
{
memcpy(data->Identification, &buffer[7], 16);
data->Identification[16] = 0;
memcpy(data->ModelStr, &buffer[23], 16);
data->ModelStr[16] = 0;
data->ModelStr[15] = 0;
memcpy(data->Version, &buffer[39], 12);
data->Version[12] = 0;
memcpy(data->Identif_bytes, &buffer[51], 12);
data->Identif_bytes[11] = 0;
data->NumBat = data->Identif_bytes[7] - 0x30;
}
void riello_parse_gn(uint8_t* buffer, TRielloData* data)
{
uint16_t pom_word;
uint32_t pom_long;
uint8_t j;
j = 7;
pom_long = (buffer[j++]-0x30)*65536;
pom_long += (buffer[j++]-0x30)*4096;
pom_long += (buffer[j++]-0x30)*256;
pom_long += (buffer[j++]-0x30)*16;
pom_long += (buffer[j++]-0x30);
if (data->Identif_bytes[0] != '1')
pom_long/=100;
assert (pom_long < UINT16_MAX);
data->NomPowerKVA = (uint16_t)pom_long;
pom_long = (buffer[j++]-0x30)*65536;
pom_long += (buffer[j++]-0x30)*4096;
pom_long += (buffer[j++]-0x30)*256;
pom_long += (buffer[j++]-0x30)*16;
pom_long += (buffer[j++]-0x30);
if (data->Identif_bytes[0] != '1')
pom_long/=100;
assert (pom_long < UINT16_MAX);
data->NomPowerKW = (uint16_t)pom_long;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->NomUbat = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->NomBatCap = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->NominalUout = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->NomFout = pom_word;
}
void riello_parse_rs(uint8_t* buffer, TRielloData* data, uint8_t numread)
{
uint16_t pom_word;
uint8_t j;
j = 7;
memcpy(data->StatusCode, &buffer[j], 5);
data->StatusCode[5] = 0;
data->Boost = riello_test_bit(&buffer[j], 9);
data->Buck = riello_test_bit(&buffer[j], 8);
data->LockUPS = riello_test_bit(&buffer[j], 2);
j+=5;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Finp = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Uinp1 = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
if (!riello_test_bit(&data->StatusCode[0], 3))
pom_word = 0;
data->Fout = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Uout1 = pom_word;
pom_word = (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Pout1 = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Fbypass = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Ubypass1 = pom_word;
pom_word = (buffer[j++]-0x30)*4096;
pom_word += (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Ubat = pom_word;
pom_word = (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->BatCap = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->BatTime = pom_word;
if (data->BatTime == 0xfff)
data->BatTime = 0xffff;
pom_word = (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Tsystem = pom_word;
if (numread > 42) {
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Uinp2 = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Uinp3 = pom_word;
}
else {
data->Uinp2 = 0;
data->Uinp3 = 0;
}
if (numread > 48) {
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Uout2 = pom_word;
pom_word = (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Pout2 = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Ubypass2 = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Uout3 = pom_word;
pom_word = (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Pout3 = pom_word;
pom_word = (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Ubypass3 = pom_word;
}
else {
data->Uout2 = 0;
data->Pout2 = 0;
data->Ubypass2 = 0;
data->Uout3 = 0;
data->Pout3 = 0;
data->Ubypass3 = 0;
}
}
void riello_parse_re(uint8_t* buffer, TRielloData* data)
{
uint16_t pom_word;
uint32_t pom_long;
uint8_t j;
j = 23;
data->Iinp1 = 0xFFFF;
data->Iinp2 = 0xFFFF;
data->Iinp3 = 0xFFFF;
pom_word = (buffer[j++]-0x30)*4096;
pom_word += (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Iout1 = pom_word;
pom_word = (buffer[j++]-0x30)*4096;
pom_word += (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Iout2 = pom_word;
pom_word = (buffer[j++]-0x30)*4096;
pom_word += (buffer[j++]-0x30)*256;
pom_word += (buffer[j++]-0x30)*16;
pom_word += (buffer[j++]-0x30);
data->Iout3 = pom_word;
pom_long = (buffer[j++]-0x30)*65536;
pom_long += (buffer[j++]-0x30)*4096;
pom_long += (buffer[j++]-0x30)*256;
pom_long += (buffer[j++]-0x30)*16;
pom_long += (buffer[j++]-0x30);
data->Pout1W = pom_long;
pom_long = (buffer[j++]-0x30)*65536;
pom_long += (buffer[j++]-0x30)*4096;
pom_long += (buffer[j++]-0x30)*256;
pom_long += (buffer[j++]-0x30)*16;
pom_long += (buffer[j++]-0x30);
data->Pout2W = pom_long;
pom_long = (buffer[j++]-0x30)*65536;
pom_long += (buffer[j++]-0x30)*4096;
pom_long += (buffer[j++]-0x30)*256;
pom_long += (buffer[j++]-0x30)*16;
pom_long += (buffer[j++]-0x30);
data->Pout3W = pom_long;
pom_long = (buffer[j++]-0x30)*65536;
pom_long += (buffer[j++]-0x30)*4096;
pom_long += (buffer[j++]-0x30)*256;
pom_long += (buffer[j++]-0x30)*16;
pom_long += (buffer[j++]-0x30);
data->Pout1VA = pom_long;
pom_long = (buffer[j++]-0x30)*65536;
pom_long += (buffer[j++]-0x30)*4096;
pom_long += (buffer[j++]-0x30)*256;
pom_long += (buffer[j++]-0x30)*16;
pom_long += (buffer[j++]-0x30);
data->Pout2VA = pom_long;
pom_long = (buffer[j++]-0x30)*65536;
pom_long += (buffer[j++]-0x30)*4096;
pom_long += (buffer[j++]-0x30)*256;
pom_long += (buffer[j++]-0x30)*16;
pom_long += (buffer[j++]-0x30);
data->Pout3VA = pom_long;
}
void riello_parse_rc(uint8_t* buffer, TRielloData* data)
{
uint8_t j, i;
j = 7;
for (i = 0; i < 22; i++, j+=2) {
data->StatusCodeT[i] = (char)(buffer[j+1]-0x30);
data->StatusCodeT[i] |= ((buffer[j]-0x30) << 4);
}
data->StatusCodeT[23] = 0;
data->StatusCodeT[24] = 0;
}
void riello_parse_sentr(uint8_t* buffer, TRielloData* data)
{
uint32_t pom;
data->Model = buffer[2]+256*buffer[3];
if (data->Model < 3000) {
if ((data->Model % 10) >= 4) {
if (buffer[100] & 0x01)
requestSENTR = SENTR_EXT176;
else
requestSENTR = SENTR_ALSO240;
}
else
requestSENTR = SENTR_ONLY192;
data->NomPowerKVA = data->Model/10;
}
else {
if (((data->Model-3000) % 10) >= 4) {
if (buffer[100] & 0x01)
requestSENTR = SENTR_EXT176;
else
requestSENTR = SENTR_ALSO240;
}
else
requestSENTR = SENTR_ONLY192;
data->NomPowerKVA = (data->Model-3000)/10;
}
if (buffer[76] & 0x08)
data->NomPowerKW = ((data->NomPowerKVA * 1000) * 9 / 10) / 1000;
else
data->NomPowerKW = ((data->NomPowerKVA * 1000) * 8 / 10) / 1000;
data->NomPowerKVA *= 1000;
data->NomPowerKW *= 1000;
if (data->Model < 3000)
data->Identif_bytes[0] = '3';
else
data->Identif_bytes[0] = '4';
data->Identif_bytes[1] = '3';
data->Identif_bytes[6] = '2';
data->SWversion = buffer[4]+256*buffer[5];
data->Version[0] = (char)(uint8_t)(48 + ((data->SWversion / 1000) % 10));
data->Version[1] = (char)(uint8_t)(48 + ((data->SWversion / 100) % 10));
data->Version[2] = '.';
data->Version[3] = (char)(uint8_t)(48 + ((data->SWversion / 10) % 10));
data->Version[4] = (char)(uint8_t)(48 + (data->SWversion % 10));
if (data->Model < 3000)
pom = data->Model*100;
else
pom = (data->Model-3000)*100;
if (buffer[0] == SENTR_EXT176) {
data->Uinp1 = (buffer[117]+buffer[118]*256)/10;
data->Uinp2 = (buffer[119]+buffer[120]*256)/10;
data->Uinp3 = (buffer[121]+buffer[122]*256)/10;
data->Iinp1 = (buffer[123]+buffer[124]*256)/10;
data->Iinp2 = (buffer[125]+buffer[126]*256)/10;
data->Iinp3 = (buffer[127]+buffer[128]*256)/10;
data->Finp = buffer[41]+256*buffer[42];
data->Uout1 = (buffer[135]+buffer[136]*256)/10;
data->Uout2 = (buffer[137]+buffer[138]*256)/10;
data->Uout3 = (buffer[139]+buffer[140]*256)/10;
data->Iout1 = (buffer[141]+buffer[142]*256)/10;
data->Iout2 = (buffer[143]+buffer[144]*256)/10;
data->Iout3 = (buffer[145]+buffer[146]*256)/10;
data->Pout1 = buffer[62];
data->Pout2 = buffer[63];
data->Pout3 = buffer[64];
data->Ipout1 = buffer[65]*3;
}
else {
data->Uinp1 = buffer[35]*230/100;
data->Uinp2 = buffer[36]*230/100;
data->Uinp3 = buffer[37]*230/100;
/* TODO: Range-check the casts to uint16_t? */
data->Iinp1 = (uint16_t)(((pom/690)*buffer[38])/100);
data->Iinp2 = (uint16_t)(((pom/690)*buffer[39])/100);
data->Iinp3 = (uint16_t)(((pom/690)*buffer[40])/100);
data->Finp = buffer[41]+256*buffer[42];
if (buffer[79] & 0x80) {
data->Uout1 = buffer[59]*2;
data->Uout2 = buffer[60]*2;
data->Uout3 = buffer[61]*2;
}
else {
data->Uout1 = buffer[59];
data->Uout2 = buffer[60];
data->Uout3 = buffer[61];
}
if (buffer[73]) {
/* FIXME: Wondering how the addition below works for uint8_t[] buffer... */
/* TODO: Range-check the casts to uint16_t? */
if (buffer[73] < 100)
buffer[73]+=256;
if (data->Model < 3000) /* singlephase */
data->Iout1 = (uint16_t)(((pom/buffer[73])*buffer[62])/100);
else
data->Iout1 = (uint16_t)(((pom/buffer[73])*buffer[62])/100/3);
data->Iout2 = (uint16_t)(((pom/buffer[73])*buffer[63])/100/3);
data->Iout3 = (uint16_t)(((pom/buffer[73])*buffer[64])/100/3);
}
else {
data->Iout1 = 0;
data->Iout2 = 0;
data->Iout3 = 0;
}
if ((data->Model & 0x0007) < 4) {
data->Iout1 *= 0.9;
data->Iout2 *= 0.9;
data->Iout3 *= 0.9;
}
data->Pout1 = buffer[62];
data->Pout2 = buffer[63];
data->Pout3 = buffer[64];
data->Ipout1 = buffer[65]*3;
}
if (data->Model < 3000) {
data->Ipout2 = 0;
data->Ipout3 = 0;
}
else {
data->Ipout2 = buffer[66]*3;
data->Ipout3 = buffer[67]*3;
}
data->Fout = buffer[68]+256*buffer[69];
data->BatTime = buffer[6]+256*buffer[7];
data->BatCap = buffer[8];
if ((buffer[0] == SENTR_ALSO240) || (buffer[0] == SENTR_EXT176)) {
if (buffer[100] & 0x80)
data->Ubat = buffer[43]+256*buffer[44];
else {
if (buffer[44] < buffer[43])
data->Ubat = buffer[44]*2;
else
data->Ubat = buffer[43]*2;
}
}
else
data->Ubat = buffer[43]+256*buffer[44];
data->Ubat *= 10;
data->Ibat = buffer[45]+256*buffer[46];
if (!buffer[47])
data->Ibat = data->Ibat*10;
data->Tsystem = buffer[48];
data->NomBatCap = buffer[74]+256*buffer[75];
switch (buffer[0]) {
case SENTR_EXT176:
data->Ubypass1 = (buffer[129]+buffer[130]*256)/10;
data->Ubypass2 = (buffer[131]+buffer[132]*256)/10;
data->Ubypass3 = (buffer[133]+buffer[134]*256)/10;
data->Fbypass = buffer[57]+256*buffer[58];
break;
case SENTR_ALSO240:
data->Ubypass1 = buffer[51]*2;
data->Ubypass2 = buffer[53]*2;
data->Ubypass3 = buffer[55]*2;
data->Fbypass = buffer[57]+256*buffer[58];
break;
default:
data->Ubypass1 = buffer[51]+256*buffer[52];
data->Ubypass2 = buffer[53]+256*buffer[54];
data->Ubypass3 = buffer[55]+256*buffer[56];
data->Fbypass = buffer[57]+256*buffer[58];
break;
}
data->StatusCode[0] = 0x08;
data->StatusCode[1] = 0x00;
data->StatusCode[2] = 0x00;
data->StatusCode[3] = 0x00;
data->StatusCode[4] = 0x00;
/* Overload if (riello_test_bit(&DevData.StatusCode[4], 2)) */
if (buffer[31] & 128)
data->StatusCode[4] |= 0x04;
/* Bypass if (riello_test_bit(&DevData.StatusCode[1], 3)) */
if (((buffer[31] & 2) || (riello_test_bit(&buffer[32], 0)) || (riello_test_bit(&buffer[32], 12)) ||
(riello_test_bit(&buffer[32], 13)) || (riello_test_bit(&buffer[32], 14))) && (!(buffer[34] & 8)))
data->StatusCode[1] |= 0x08;
/* AC Fail if (riello_test_bit(&DevData.StatusCode[0], 1)) */
if (buffer[31] & 8)
data->StatusCode[0] |= 0x02;
/* LowBatt if ((riello_test_bit(&DevData.StatusCode[0], 1)) && (riello_test_bit(&DevData.StatusCode[0], 0))) */
if (buffer[31] & 16) {
if (buffer[31] & 8) {
data->StatusCode[0] |= 0x02;
data->StatusCode[0] |= 0x01;
}
}
/* Standby if (!riello_test_bit(&DevData.StatusCode[0], 3)) */
if ((buffer[22] & 2) || (buffer[34] & 4) || (buffer[34] & 8))
data->StatusCode[0] &= 0xF7;
/* Battery bad (Replace battery) if (riello_test_bit(&DevData.StatusCode[2], 0)) */
if (buffer[31] & 0x40)
data->StatusCode[2] |= 0x01;
}
void riello_init_serial()
{
wait_packet = 1;
buf_ptr_length = 0;
foundbadcrc = 0;
foundnak = 0;
}
uint8_t riello_header(uint8_t type, uint8_t a, uint8_t* length)
{
LAST_DATA[0] = LAST_DATA[1];
LAST_DATA[1] = LAST_DATA[2];
LAST_DATA[2] = LAST_DATA[3];
LAST_DATA[3] = LAST_DATA[4];
LAST_DATA[4] = LAST_DATA[5];
LAST_DATA[5] = (uint8_t) a;
switch (type) {
case DEV_RIELLOSENTRY:
if (((LAST_DATA[4]>=192) && (LAST_DATA[5]==103)) ||
((LAST_DATA[4]==176) && (LAST_DATA[5]==164))) {
*length = LAST_DATA[5];
return(1);
}
break;
case DEV_RIELLOGPSER:
if ((buf_ptr_length==0) && (LAST_DATA[5]>0x20) && (LAST_DATA[4]==0x2))
return(1);
break;
}
return(0);
}
uint8_t riello_tail(uint8_t type, uint8_t length)
{
uint8_t number;
switch (type) {
case DEV_RIELLOSENTRY:
number = length;
if (buf_ptr_length >= number)
return(1);
break;
case DEV_RIELLOGPSER:
if (LAST_DATA[5] == 0x03)
return(1);
break;
}
return(0);
}
uint8_t riello_test_nak(uint8_t type, uint8_t* buffer)
{
switch (type) {
case DEV_RIELLOGPSER:
if (buffer[3] == 0x15)
return(1);
break;
}
return(0);
}
void riello_parse_serialport(uint8_t typedev, uint8_t* buffer, uint8_t checksum)
{
static uint8_t actual_char, int_i;
static uint8_t length;
actual_char = commbyte;
if ((riello_header(typedev, actual_char, &length)) && (!foundheader)) {
upsdebugx(5,"Header detected: LAST_DATA:%X,%X,%X,%X,%X,%X buf_ptr:%i \n\r",
LAST_DATA[0], LAST_DATA[1], LAST_DATA[2],
LAST_DATA[3], LAST_DATA[4], LAST_DATA[5], buf_ptr_length);
foundheader = 1;
buf_ptr_length = 1;
memset(buffer, 0, BUFFER_SIZE);
buffer[0] = LAST_DATA[4];
}
if ((foundheader) && (buf_ptr_length < BUFFER_SIZE))
buffer[buf_ptr_length++] = actual_char;
if ((foundheader) && (riello_tail(typedev, length))) {
upsdebugx(5,"\n\rEnd detected: LAST_DATA:%X,%X,%X,%X,%X,%X buf_ptr:%i \n\r",
LAST_DATA[0], LAST_DATA[1], LAST_DATA[2],
LAST_DATA[3], LAST_DATA[4], LAST_DATA[5], buf_ptr_length);
foundheader = 0;
for (int_i=0; int_i<6; int_i++)
LAST_DATA[int_i] = 0;
if (riello_test_nak(typedev, buffer)) {
wait_packet = 0;
foundnak = 1;
}
if (riello_test_crc(typedev, buffer, buf_ptr_length, checksum)) {
wait_packet = 0;
foundbadcrc = 1;
}
else {
wait_packet = 0;
foundbadcrc = 0;
}
}
}
Reference in New Issue View Git Blame Copy Permalink