maxim/yau07b-stm32
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Доработка. Добавление опроса УКП и вывод в широковещание данных (103 буфер)

Browse Source
This commit is contained in:
Maxim
2024-11-12 14:40:16 +03:00
parent a712d75c76
commit e279f7630e
1 changed files with 13 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
Core/Src/pribors.c
View File

@@ -107,8 +107,8 @@ uint16_t set_status_prd(unsigned char *buf)
for (uint16_t i = 1; i <14; i++) for (uint16_t i = 1; i <14; i++)
{ {
write_isa( BASE_ADDR_EMS_G + 0xC, i ); write_isa(BASE_ADDR_EMS_G + 0xC, i );
ports_data = read_isa( BASE_ADDR_EMS_G + 0xE ); ports_data = read_isa(BASE_ADDR_EMS_G + 0xE );
buf[9 + (i - 1) * 2] = ports_data & 0xFF; buf[9 + (i - 1) * 2] = ports_data & 0xFF;
buf[10 + (i -1) * 2] = ports_data >> 8; buf[10 + (i -1) * 2] = ports_data >> 8;
} }
@@ -120,24 +120,28 @@ uint16_t set_status_prd(unsigned char *buf)
buf[37] = ports_data & 0xFF; buf[37] = ports_data & 0xFF;
buf[38] = ports_data >> 8; buf[38] = ports_data >> 8;
ports_data = 0x55AA;
//BASE_ADDR_UKP0 //BASE_ADDR_UKP0
for (uint16_t i = 0; i <8; i++)
{
for (uint16_t i = 0; i <16; i++)
{
ports_data = read_isa(BASE_ADDR_UKP0 + 0x8);
buf[39 + i * 2] = ports_data & 0xFF; buf[39 + i * 2] = ports_data & 0xFF;
buf[40 + i * 2] = ports_data >> 8; buf[40 + i * 2] = ports_data >> 8;
} }
write_isa(BASE_ADDR_UKP0 + 0x4, 1);
//BASE_ADDR_UKP1 //BASE_ADDR_UKP1
for (uint16_t i = 0; i <8; i++) for (uint16_t i = 0; i <16; i++)
{ {
buf[55 + i * 2] = ports_data & 0xFF; ports_data = read_isa(BASE_ADDR_UKP1 + 0x8);
buf[56 + i * 2] = ports_data >> 8; buf[71 + i * 2] = ports_data & 0xFF;
buf[72 + i * 2] = ports_data >> 8;
} }
write_isa(BASE_ADDR_UKP1 + 0x4, 1);
pribor_type = PRIBOR_TYPE_PRD; pribor_type = PRIBOR_TYPE_PRD;
buf[6] = 63; buf[6] = 103;
return buf[6] + 2; return buf[6] + 2;
} }