Merge origin/ump-v4 into main
Combine Flash CAN updates, signal processing and HOPE pin fixes with current Modbus/GAS, STM32 ports and CCS release exports. Resolve protocol, documentation and Qt conflicts; deduplicate Android JNI sources and include gauge/IGBT sources in host builds.
This commit is contained in:
@@ -61,7 +61,7 @@ int balsam_can_decode(uint32_t can_id, const uint8_t *data, size_t size,
|
||||
relative = can_id - BALSAM_CAN_BASE_ID;
|
||||
output->direction = relative >= BALSAM_CAN_DATA_OFFSET
|
||||
? BALSAM_CAN_FROM_NODE : BALSAM_CAN_TO_NODE;
|
||||
output->device = (uint8_t)((relative & 0x0FU) + 1U);
|
||||
output->device = (uint8_t)((relative & 0x0FU) + 1U); /* В ecan.c перед сборкой CAN ID выполняется DevNum--; маска 0x0F выделяет индекс 0..12, а +1 восстанавливает номер Mode. */
|
||||
if (can_id == 0x00745009UL || can_id == 0x00745019UL) {
|
||||
output->device = 10U;
|
||||
output->direction = can_id == 0x00745019UL
|
||||
@@ -80,9 +80,9 @@ int balsam_can_decode(uint32_t can_id, const uint8_t *data, size_t size,
|
||||
const char *balsam_can_device_name(uint8_t device)
|
||||
{
|
||||
static const char *const names[BALSAM_CAN_NODE_COUNT] = {
|
||||
"Трансформатор 1", "Трансформатор 2", "Силовой блок 1",
|
||||
"Силовой блок 2", "УМП 1", "УМП 2", "Двигатель", "ВЭП",
|
||||
"Задатчик", "Пульт (МПУ)", "Узел 11", "Узел 12", "Терминал"
|
||||
"Трансформатор 1", "Трансформатор 2", "Силовой 1", /* Первые три узла соответствуют строкам 1..3 предоставленной таблицы адресов 167. */
|
||||
"Силовой 2", "УМП 1", "УМП 2", "Двигатель", "Задатчик", /* Строки 4..8 таблицы; VPU1_CAN_DEVICE=8 соответствует задатчику, а не ВЭП. */
|
||||
"ВЭП", "ПМУ", "Узел 11", "Узел 12", "Терминал" /* Строка 9 — ВЭП, пара 0xBA0009/0xBA0019 — ПМУ; служебные узлы 11..13 сохраняют прежние назначения. */
|
||||
};
|
||||
return (device >= 1U && device <= BALSAM_CAN_NODE_COUNT)
|
||||
? names[device - 1U] : "Неизвестный узел";
|
||||
@@ -91,6 +91,13 @@ const char *balsam_can_device_name(uint8_t device)
|
||||
size_t balsam_can_register_name(uint8_t device, uint16_t address,
|
||||
char *output, size_t output_size)
|
||||
{
|
||||
if (address == 0x0100U) /* CAN_HEARTBEAT_ADDR в ecan.c периферии 167 задаёт служебный адрес вне технологической карты R0..R127. */
|
||||
return copy_name("Heartbeat: счётчик, с", output, output_size); /* Первое слово hiword содержит секунды после запуска по модулю 65536. */
|
||||
if (address == 0x0101U) /* Следующее слово heartbeat соответствует старшим 16 битам loword в CAN_send. */
|
||||
return copy_name("Heartbeat: Mode", output, output_size); /* Прошивка передаёт аппаратный Mode без уменьшения на единицу, применяемого только к CAN ID. */
|
||||
if (address == 0x0102U) /* Третье слово heartbeat соответствует младшим 16 битам loword. */
|
||||
return copy_name("Heartbeat: тип платы (Desk)", output, output_size); /* Значение Desk задаёт тип платы и отличается от номера Mode и номера CAN-узла. */
|
||||
|
||||
if ((device == 1U || device == 2U) && address < 20U)
|
||||
return indexed_name("Диагностика T°", address + 1U, output, output_size);
|
||||
if ((device == 1U || device == 2U) && address >= 0x18U && address <= 0x2BU)
|
||||
@@ -139,7 +146,7 @@ size_t balsam_can_register_name(uint8_t device, uint16_t address,
|
||||
if (device == 7U && address >= 0x18U && address <= 0x1FU)
|
||||
return indexed_name("Показания T°", address - 0x17U, output, output_size);
|
||||
|
||||
if (device == 8U) {
|
||||
if (device == 9U) { /* Карта напряжений принадлежит ВЭП с adr_SHKF=9; задатчик с номером 8 использует другую карту. */
|
||||
static const char *const vep_names[] = {
|
||||
"Диагностика 380В Ф1", "Диагностика 380В Ф2",
|
||||
"Диагностика 31В Ф1", "Диагностика 31В Ф2",
|
||||
@@ -164,15 +171,15 @@ size_t balsam_can_register_name(uint8_t device, uint16_t address,
|
||||
return copy_name("Дискретные датчики (14 бит)", output, output_size);
|
||||
}
|
||||
|
||||
if (device == 9U && address == 0U)
|
||||
if (device == 8U && address == 0U) /* У VPU1_CAN_DEVICE=8 слово 0 передаёт обороты ГЭД, а не диагностику ВЭП. */
|
||||
return copy_name("Обороты ГЭД, об/мин", output, output_size);
|
||||
if (device == 9U && address == 1U)
|
||||
if (device == 8U && address == 1U) /* Слово 1 той же платы задатчика содержит обороты гребного вала. */
|
||||
return copy_name("Обороты ГВ, об/мин", output, output_size);
|
||||
if (device == 9U && address == 2U)
|
||||
if (device == 8U && address == 2U) /* ADR_CAN_LAMPS_ON_VPU=2 задаёт регистр первой группы ламп задатчика. */
|
||||
return copy_name("Лампы (8 бит)", output, output_size);
|
||||
if (device == 9U && address == 3U)
|
||||
if (device == 8U && address == 3U) /* ADR_CAN_LAMPS_2_ON_VPU=3 задаёт регистр второй группы индикаторов задатчика. */
|
||||
return copy_name("Диоды (16 бит)", output, output_size);
|
||||
if (device == 9U && address == 0x10U)
|
||||
if (device == 8U && address == 0x10U) /* ADR_CAN_KEY_ON_VPU=16, то есть 0x10, задаёт слово кнопок VPU; адрес не перенумеровывается. */
|
||||
return copy_name("Кнопки (12 бит)", output, output_size);
|
||||
|
||||
if (address == 0x16U)
|
||||
|
||||
File diff suppressed because one or more lines are too long
@@ -7,6 +7,8 @@
|
||||
#include "set_plot.h"
|
||||
#include <math.h>
|
||||
|
||||
#define MIN_VIEW_SPAN 1e-12 /* Минимальная безразмерная доля полного диапазона по X и Y задаёт увеличение до 10^12 раз; запас относительно точности double сохраняет различимые границы нормированной области. */
|
||||
|
||||
static double clamp(double v, double lo, double hi) { return fmin(hi, fmax(lo, v)); }
|
||||
static int finite_values(const double *v, size_t n) {
|
||||
size_t i;
|
||||
@@ -23,13 +25,13 @@ size_t set_plot_eval(uint32_t op, const double *v, size_t n, double *out, size_t
|
||||
cap < (op == SET_PLOT_TRANSFORM || op == SET_PLOT_LIMITS ? 4U : 1U)) return 0;
|
||||
if (op == SET_PLOT_TRANSFORM) {
|
||||
double w, h, fx, fy;
|
||||
if (!finite_values(v, 4) || v[2] < 1.0/128 || v[2] > 1 ||
|
||||
v[3] < 1.0/128 || v[3] > 1 || v[0] < 0 || v[1] < 0 ||
|
||||
if (!finite_values(v, 4) || v[2] < MIN_VIEW_SPAN || v[2] > 1 || /* Проверяем конечность смещений и размеров, разрешая ширину до триллионной доли исходного диапазона X. */
|
||||
v[3] < MIN_VIEW_SPAN || v[3] > 1 || v[0] < 0 || v[1] < 0 || /* Такой же предел для Y сохраняет возможность дальнейшего перемещения и увеличения уже приближённой области. */
|
||||
v[0] + v[2] > 1.000000000001 || v[1] + v[3] > 1.000000000001) return 0;
|
||||
out[0] = v[0]; out[1] = v[1]; out[2] = v[2]; out[3] = v[3];
|
||||
if (!finite_values(v + 4, 6) || v[4] <= 0 || v[5] <= 0) return 4;
|
||||
w = clamp(v[2] / v[4], 1.0/128, 1);
|
||||
h = clamp(v[3] / v[5], 1.0/128, 1);
|
||||
w = clamp(v[2] / v[4], MIN_VIEW_SPAN, 1); /* Делим текущую долю X на положительный коэффициент приближения; ограничиваем результат между новым пределом и полным диапазоном. */
|
||||
h = clamp(v[3] / v[5], MIN_VIEW_SPAN, 1); /* Аналогично масштабируем Y, снимая прежнее ограничение 128 раз и сохраняя ненулевую высоту для координатных преобразований. */
|
||||
fx = clamp(v[8], 0, 1); fy = clamp(v[9], 0, 1);
|
||||
out[0] = clamp(v[0] + (v[2] - w) * fx - v[6] * w, 0, 1 - w);
|
||||
out[1] = clamp(v[1] + (v[3] - h) * fy - v[7] * h, 0, 1 - h);
|
||||
|
||||
@@ -33,14 +33,14 @@ static double evaluate(double t,const double *x,const double *y,size_t n,
|
||||
return (2*u*u*u-3*u*u+1)*y[i]+(u*u*u-2*u*u+u)*h*d[i]
|
||||
+(-2*u*u*u+3*u*u)*y[i+1]+(u*u*u-u*u)*h*d[i+1];
|
||||
}
|
||||
int set_signal_reconstruct(const double *input_x,const double *input_y,size_t count,
|
||||
int method,unsigned degree,size_t output_count,int endpoint,double *out_x,
|
||||
double *out_y,double *meta,double *work,size_t work_count) {
|
||||
int set_signal_reconstruct_with_fit(const double *input_x,const double *input_y,size_t count, /* Общая подготовка данных обслуживает исходный и подключаемый решатели. */
|
||||
int method,unsigned degree,size_t output_count,int endpoint,double *out_x, /* Метод, степень и временная сетка сохраняют контракт существующего API. */
|
||||
double *out_y,double *meta,double *work,size_t work_count,set_signal_fit_fn fit) { /* NULL выбирает прежний МНК; другой callback получает уже нормированные данные. */
|
||||
point *pairs; double *x,*y,*d,*h,*s,*q,*column;
|
||||
double coef[6]={0},r[6][6]={{0}},origin,span,scale=1,rmse=0;
|
||||
size_t i,j,k,n=0; unsigned pass;
|
||||
if(!input_x||!input_y||!out_x||!out_y||!meta||!work || count<2||count>100000
|
||||
||output_count<2||output_count>10000||work_count<14*count+128
|
||||
||output_count<2||output_count>1000000||work_count<14*count+128
|
||||
||method<0||method>3||(endpoint!=0&&endpoint!=1)) return 1;
|
||||
pairs=(point *)work; x=work+2*count; y=x+count; d=y+count; h=d+count;
|
||||
s=h+count; q=s+count; column=q+6*count;
|
||||
@@ -65,6 +65,10 @@ int set_signal_reconstruct(const double *input_x,const double *input_y,size_t co
|
||||
}
|
||||
if(method==SET_SIGNAL_POLYNOMIAL) {
|
||||
if(degree<1||degree>5||n<=degree) return 1;
|
||||
if(fit) { /* Подключаемый решатель заменяет только вычисление коэффициентов МНК. */
|
||||
int status=fit(x,y,n,degree,coef); /* Передаём уникальные нормированные точки и массив до шести коэффициентов. */
|
||||
if(status) return status; /* Ошибка ранга или памяти возвращается явно, без скрытого перехода на другой решатель. */
|
||||
} else { /* Исходный алгоритм остаётся неизменным вариантом для сравнения и прошивок. */
|
||||
for(j=0;j<=degree;++j) {
|
||||
double norm=0;
|
||||
for(i=0;i<n;++i) column[i]=pow(2*x[i]-1,(double)j);
|
||||
@@ -81,6 +85,7 @@ int set_signal_reconstruct(const double *input_x,const double *input_y,size_t co
|
||||
j=i-1; for(k=j+1;k<=degree;++k) coef[j]-=r[j][k]*coef[k];
|
||||
coef[j]/=r[j][j];
|
||||
}
|
||||
} /* Оба решателя возвращают коэффициенты в одном базисе для общего evaluate. */
|
||||
} else if(method==SET_SIGNAL_PCHIP) {
|
||||
d[0]=d[n-1]=s[0];
|
||||
if(n>2) {
|
||||
@@ -112,6 +117,11 @@ int set_signal_reconstruct(const double *input_x,const double *input_y,size_t co
|
||||
meta[0]=(double)count; meta[1]=(double)n; meta[2]=sqrt(rmse)*scale;
|
||||
return isfinite(meta[2])?0:2;
|
||||
}
|
||||
int set_signal_reconstruct(const double *input_x,const double *input_y,size_t count, /* Сохраняем прежний экспорт и поведение всех существующих клиентов. */
|
||||
int method,unsigned degree,size_t output_count,int endpoint,double *out_x, /* Параметры передаются без изменения единиц времени и амплитуды. */
|
||||
double *out_y,double *meta,double *work,size_t work_count) { /* Владение выходами и рабочим буфером по-прежнему остаётся у вызывающего. */
|
||||
return set_signal_reconstruct_with_fit(input_x,input_y,count,method,degree,output_count,endpoint,out_x,out_y,meta,work,work_count,NULL); /* NULL выбирает исходный двухпроходный МНК без зависимости от C++. */
|
||||
} /* Завершаем совместимую обёртку исходного C ABI. */
|
||||
int set_signal_dac12(const double *volts,size_t count,double vref,uint16_t *codes) {
|
||||
size_t i;
|
||||
if(!volts||!codes||count<2||count>10000||!isfinite(vref)||vref<=0) return 1;
|
||||
|
||||
@@ -13,18 +13,41 @@ static size_t seal(uint8_t *p,size_t n) {
|
||||
uint16_t crc=set_crc16_modbus(p,n);p[n]=(uint8_t)crc;p[n+1]=(uint8_t)(crc>>8);return n+2;
|
||||
}
|
||||
void set_wave_init(set_wave_state *s,uint16_t *samples,size_t capacity,const set_wave_port *port) {
|
||||
memset(s,0,sizeof(*s));s->samples=samples;s->capacity=capacity;s->rate=1000;
|
||||
memset(s,0,sizeof(*s));s->samples=samples;s->capacity=capacity;s->rate=1000;s->channels=1; /* После reset сохраняет совместимость с прежним одноканальным клиентом. */
|
||||
if(port) s->port=*port;
|
||||
}
|
||||
void set_wave_enable_xy(set_wave_state *s,uint32_t *pairs,int (*start)(void *,const uint32_t *,size_t,uint32_t)) { /* Плата явно объявляет доступность второго выхода и его SRAM. */
|
||||
s->xy_samples=pairs;s->start_xy=start; /* Нулевой callback оставляет устройство одноканальным, включая прежние F103 и G474RB. */
|
||||
} /* Подключение порта не запускает периферию и не меняет таблицу. */
|
||||
static uint16_t sample_get(const set_wave_state *s,unsigned index) { /* Читает выбранную координату без перестановки готовых пар перед DMA. */
|
||||
return s->channels==2?(uint16_t)((s->xy_samples[index]>>(16u*s->selected))&4095u):s->samples[index]; /* Полуслова DHR12RD разделены 16 битами; код каждого DAC занимает 12 бит. */
|
||||
} /* Одноканальный формат uint16_t остаётся прежним. */
|
||||
static void sample_set(set_wave_state *s,unsigned index,uint16_t value) { /* Изменяет только выбранную координату, сохраняя парный отсчёт другого канала. */
|
||||
if(s->channels==2) { /* Двухканальная таблица уже хранится в формате единственной 32-битной передачи DMA. */
|
||||
unsigned shift=16u*s->selected; /* Сдвиг 0 выбирает X/PA4, сдвиг 16 выбирает Y/PA5 по DHR12RD из RM0090/RM0440. */
|
||||
s->xy_samples[index]=(s->xy_samples[index]&~(0xffffu<<shift))|((uint32_t)value<<shift); /* Очищает полуслово вместе с резервными битами и записывает проверенный 12-битный код. */
|
||||
} else s->samples[index]=value; /* Сохраняет прежнюю компактную таблицу одиночного канала. */
|
||||
} /* Проверки диапазона выполняет вызывающий обработчик до изменения памяти. */
|
||||
static unsigned write_register(set_wave_state *s,unsigned reg,unsigned value) {
|
||||
if(reg==SET_WAVE_BASE+2 && value==0) {
|
||||
if(s->port.stop) s->port.stop(s->port.context);
|
||||
s->running=0; return 0;
|
||||
}
|
||||
if(reg==SET_WAVE_BASE+10) { /* Выбор X/Y меняет только окно загрузки и чтения, поэтому доступен и при воспроизведении. */
|
||||
uint16_t previous; /* Временно сохраняет счётчик прежней координаты при переключении окна. */
|
||||
if(value>=s->channels)return 3; /* Одноканальная плата отвергает Y; произвольные индексы не меняют состояние. */
|
||||
if(value!=s->selected) {previous=s->received;s->received=s->received_other;s->received_other=previous;s->selected=(uint16_t)value;} /* Меняет местами счётчики, сохраняя оба независимо от порядка загрузки. */
|
||||
return 0; /* Выбор окна не снимает commit и не меняет фазу аппаратного вывода. */
|
||||
} /* Остальные изменения таблицы запрещены во время running. */
|
||||
if(s->running) return 6;
|
||||
if(reg==SET_WAVE_BASE+9) { /* Число одновременно воспроизводимых каналов задаётся до начала новой загрузки. */
|
||||
if(value<1||value>2||(value==2&&(!s->xy_samples||!s->start_xy)))return 3; /* Двойной режим допустим только с буфером пар и аппаратным исполнителем. */
|
||||
s->channels=(uint16_t)value;s->selected=0;s->count=s->received=s->received_other=s->ready=0; /* Смена формата инвалидирует обе координаты, исключая запуск смешанной старой таблицы. */
|
||||
return 0; /* Пуск остаётся отдельной командой после полного commit. */
|
||||
} /* Прежние регистры частоты и длины сохраняют адреса. */
|
||||
if(reg==SET_WAVE_BASE+2 && value==1) {
|
||||
if(!s->ready||!s->port.start) return 3;
|
||||
if(s->port.start(s->port.context,s->samples,s->count,s->rate)) return 4;
|
||||
if(s->channels==2?s->start_xy(s->port.context,s->xy_samples,s->count,s->rate):s->port.start(s->port.context,s->samples,s->count,s->rate)) return 4; /* XY запускается одной аппаратной транзакцией; ошибка порта не выставляет running. */
|
||||
s->running=1;return 0;
|
||||
}
|
||||
if(reg==SET_WAVE_BASE+3) {
|
||||
@@ -38,37 +61,38 @@ static unsigned write_register(set_wave_state *s,unsigned reg,unsigned value) {
|
||||
}
|
||||
if(reg==SET_WAVE_BASE+4) {
|
||||
if(value<2||value>SET_WAVE_MAX||value>s->capacity) return 3;
|
||||
s->count=(uint16_t)value;s->received=s->ready=0;return 0;
|
||||
s->count=(uint16_t)value;s->received=s->received_other=s->ready=0; /* Новая длина начинает загрузку обеих координат с нуля. */return 0;
|
||||
}
|
||||
if(reg>=SET_WAVE_DATA&®<SET_WAVE_DATA+SET_WAVE_MAX) {
|
||||
unsigned index=reg-SET_WAVE_DATA;
|
||||
if(index>=s->count||index>s->received||value>4095||s->ready) return 3;
|
||||
if(index<s->received) return s->samples[index]==value?0:3;
|
||||
s->samples[index]=(uint16_t)value;++s->received;return 0;
|
||||
if(index<s->received) return sample_get(s,index)==value?0:3; /* Повтор подтверждается только при совпадении выбранной координаты; соседнее полуслово пары не учитывается. */
|
||||
sample_set(s,index,(uint16_t)value); /* Готовит 16-битный отсчёт либо соответствующее полуслово XY. */++s->received;return 0;
|
||||
}
|
||||
if(reg==SET_WAVE_BASE+6) {
|
||||
if(value!=0xA55A||s->count<2||s->received!=s->count) return 3;
|
||||
if(value!=0xA55A||s->count<2||s->received!=s->count||(s->channels==2&&s->received_other!=s->count)) return 3; /* Общий commit требует полные X и Y одинаковой длины. */
|
||||
s->ready=1;return 0;
|
||||
}
|
||||
return 2;
|
||||
}
|
||||
unsigned set_wave_read(void *ctx,uint16_t off,uint16_t count,uint16_t *out) {
|
||||
set_wave_state *s=(set_wave_state *)ctx;uint16_t w[9];unsigned i;
|
||||
if(!s||!s->samples||!out||!count||(uint32_t)off+count>9)return 2;
|
||||
set_wave_state *s=(set_wave_state *)ctx;uint16_t w[13]; /* Девять прежних слов дополнены режимом, селектором, возможностями и вторым счётчиком XY. */unsigned i;
|
||||
if(!s||!s->samples||!out||!count||(uint32_t)off+count>13)return 2; /* Проверяет весь диапазон расширенного статуса до чтения четырёх дополнительных слов XY. */
|
||||
w[0]=0x5747;w[1]=3;w[2]=s->running;w[3]=(uint16_t)s->rate;
|
||||
w[4]=s->count;w[5]=s->received;w[6]=s->ready;w[7]=(uint16_t)s->capacity;w[8]=(uint16_t)(s->rate>>16);
|
||||
w[9]=s->channels;w[10]=s->selected;w[11]=s->start_xy?2:1;w[12]=s->received_other; /* Расширение 0x1309…0x130C не меняет WG v3 и прежний ответ из восьми слов. */
|
||||
for(i=0;i<count;++i)out[i]=w[off+i];
|
||||
return 0;
|
||||
}
|
||||
unsigned set_wave_write(void *ctx,uint16_t off,uint16_t value) {
|
||||
set_wave_state *s=(set_wave_state *)ctx;
|
||||
if(!s||!s->samples||off>=9)return 2;
|
||||
if(!s||!s->samples||off>=11)return 2; /* Запись разрешена до селектора 0x130A включительно; возможности и второй счётчик доступны только для чтения. */
|
||||
return write_register(s,SET_WAVE_BASE+off,value);
|
||||
}
|
||||
unsigned set_wave_samples_read(void *ctx,uint16_t off,uint16_t count,uint16_t *out) {
|
||||
set_wave_state *s=(set_wave_state *)ctx;unsigned i;
|
||||
if(!s||!s->samples||!out||!count||(uint32_t)off+count>s->received)return 2;
|
||||
for(i=0;i<count;++i)out[i]=s->samples[off+i];
|
||||
for(i=0;i<count;++i)out[i]=sample_get(s,off+i) /* Возвращает выбранный канал из общей таблицы пар. */;
|
||||
return 0;
|
||||
}
|
||||
unsigned set_wave_samples_write(void *ctx,uint16_t off,uint16_t value) {
|
||||
@@ -77,21 +101,22 @@ unsigned set_wave_samples_write(void *ctx,uint16_t off,uint16_t value) {
|
||||
return write_register(s,SET_WAVE_DATA+off,value);
|
||||
}
|
||||
size_t set_wave_rtu(set_wave_state *s,unsigned device,const uint8_t *req,size_t n,uint8_t *out,size_t cap) {
|
||||
unsigned reg,value,error=0,i;uint16_t status[8];size_t length=0;
|
||||
unsigned reg,value,error=0,i;uint16_t status[13]; /* Вмещает прежний статус и дополнительные регистры XY без изменения старого запроса. */size_t length=0;
|
||||
if(!s||!s->samples||!req||!out||cap<21||n!=8||device<1||device>247
|
||||
||req[0]!=device||set_crc16_modbus(req,n)) return 0;
|
||||
reg=read16(req+2);value=read16(req+4);
|
||||
if(!((reg>=SET_WAVE_BASE&®<SET_WAVE_BASE+9)||(reg>=SET_WAVE_DATA&®<SET_WAVE_DATA+SET_WAVE_MAX))) return 0;
|
||||
if(!((reg>=SET_WAVE_BASE&®<SET_WAVE_BASE+13)||(reg>=SET_WAVE_DATA&®<SET_WAVE_DATA+SET_WAVE_MAX))) return 0; /* Общий RTU-кодек узнаёт расширенное окно XY и прежнюю таблицу без захвата чужих адресов. */
|
||||
out[0]=(uint8_t)device;out[1]=req[1];
|
||||
if(req[1]==6) {error=write_register(s,reg,value);memcpy(out,req,6);length=6;}
|
||||
else if(req[1]==3) {
|
||||
(void)set_wave_read(s,0,8,status);
|
||||
if(reg==SET_WAVE_BASE&&value==8) {
|
||||
out[2]=16;for(i=0;i<8;++i) write16(out+3+2*i,status[i]);length=19;
|
||||
} else if(reg==SET_WAVE_BASE+8&&value==1) {
|
||||
out[2]=2;write16(out+3,s->rate>>16);length=5;
|
||||
} else if(reg>=SET_WAVE_DATA&&value==1&®-SET_WAVE_DATA<s->received) {
|
||||
out[2]=2;write16(out+3,s->samples[reg-SET_WAVE_DATA]);length=5;
|
||||
if(reg>=SET_WAVE_BASE&®<SET_WAVE_BASE+13&&value&&value<=13) { /* Отдельный RTU-кодек читает те же регистры, что общий сервер SET v2. */
|
||||
error=set_wave_read(s,(uint16_t)(reg-SET_WAVE_BASE),(uint16_t)value,status); /* Проверяет весь диапазон до формирования ответа. */
|
||||
if(!error) { /* Ошибочный диапазон возвращает исключение без чтения за пределами статуса. */
|
||||
if(cap<5u+2u*value)return 0; /* Не пишет ответ расширенного статуса в прежний короткий буфер. */
|
||||
out[2]=(uint8_t)(2u*value);for(i=0;i<value;++i)write16(out+3+2*i,status[i]);length=3u+2u*value; /* Отдаёт точное запрошенное число слов с прежним порядком байтов Modbus. */
|
||||
} /* CRC добавляется общим seal после формирования тела. */
|
||||
} else if(reg>=SET_WAVE_DATA&&value==1&®-SET_WAVE_DATA<s->received) { /* Чтение одного отсчёта сохраняет старый wire-контракт. */
|
||||
out[2]=2;write16(out+3,sample_get(s,reg-SET_WAVE_DATA));length=5; /* XY возвращает выбранную координату, mono возвращает прежний uint16_t. */
|
||||
} else error=2;
|
||||
} else error=1;
|
||||
if(error) {out[1]|=0x80;out[2]=(uint8_t)error;length=3;}
|
||||
@@ -111,6 +136,9 @@ size_t set_wave_request(unsigned device,unsigned op,unsigned index,unsigned valu
|
||||
case 7: if(index>=SET_WAVE_MAX)return 0;reg=SET_WAVE_DATA+index;fn=3;value=1;break;
|
||||
case 8: reg+=8;fn=3;value=1;break;
|
||||
case 9: reg+=8;if(value>(SET_WAVE_MAX_RATE>>16))return 0;break;
|
||||
case 10: reg+=9;if(value<1||value>2)return 0;break; /* Выбирает один или два синхронных канала через существующий RTU/SET v2 транспорт. */
|
||||
case 11: reg+=10;if(value>1)return 0;break; /* Выбирает X=0 либо Y=1 для прежних команд sample/block/readback. */
|
||||
case 12: reg+=9;fn=3;value=4;break; /* Читает режим, селектор, возможности порта и количество отсчётов второй координаты. */
|
||||
default:return 0;
|
||||
}
|
||||
out[0]=(uint8_t)device;out[1]=(uint8_t)fn;write16(out+2,reg);write16(out+4,value);return seal(out,6);
|
||||
@@ -131,7 +159,7 @@ int set_wave_response(const uint8_t *req,const uint8_t *reply,size_t size,uint16
|
||||
if(req[1]==6) {if(memcmp(req,reply,8)||cap<1)return -1;words[0]=read16(req+4);return 1;}
|
||||
if(reply[2]!=expected-5||cap<(expected-5)/2)return -1;
|
||||
for(i=0;i<(expected-5)/2;++i)words[i]=read16(reply+3+2*i);
|
||||
if(read16(req+2)==SET_WAVE_BASE&&(words[0]!=0x5747||(words[1]<1||words[1]>3)))return -2;
|
||||
if(read16(req+2)==SET_WAVE_BASE&&read16(req+4)>=2&&(words[0]!=0x5747||(words[1]<1||words[1]>3)))return -2; /* Версия проверяется только при наличии двух слов, исключая чтение за границей короткого ответа. */
|
||||
return (int)((expected-5)/2);
|
||||
}
|
||||
|
||||
@@ -168,13 +196,13 @@ size_t set_wave_block_rtu(set_wave_state *s,unsigned device,const uint8_t *req,
|
||||
/* Preflight the whole block, including replayed prefix, before writing. */
|
||||
for(i=0;i<count;++i) {
|
||||
unsigned value=read16(req+7+2*i);
|
||||
if(value>4095||(index+i<s->received&&s->samples[index+i]!=value)) {
|
||||
if(value>4095||(index+i<s->received&&sample_get(s,index+i)!=value)) {
|
||||
error=3;break;
|
||||
}
|
||||
}
|
||||
if(!error) {
|
||||
if(cap<8)return 0;
|
||||
for(i=0;i<count;++i)s->samples[index+i]=read16(req+7+2*i);
|
||||
for(i=0;i<count;++i)sample_set(s,index+i,read16(req+7+2*i)); /* После preflight записывает весь блок только выбранной координаты. */
|
||||
if(index+count>s->received)s->received=(uint16_t)(index+count);
|
||||
memcpy(out,req,6);length=6;
|
||||
}
|
||||
@@ -184,7 +212,7 @@ size_t set_wave_block_rtu(set_wave_state *s,unsigned device,const uint8_t *req,
|
||||
else {
|
||||
if(cap<5+2*(size_t)count)return 0;
|
||||
out[2]=(uint8_t)(2*count);
|
||||
for(i=0;i<count;++i)write16(out+3+2*i,s->samples[index+i]);
|
||||
for(i=0;i<count;++i)write16(out+3+2*i,sample_get(s,index+i)); /* Чтение блоков использует тот же селектор, что и запись. */
|
||||
length=3+2*(size_t)count;
|
||||
}
|
||||
} else error=1;
|
||||
|
||||
Reference in New Issue
Block a user