Форум программистов [Powered by Invision Power Board]

Код


char YesStop=0;
char SSS[80];
unsigned Ready;
int W;
Ready=1;
byte Cur_Count;
BOOL Read_ADC_Expos(int *Data_ADC_1,int *Data_ADC_2 )
{
int W;
byte Ready;
loop:
if (YesStop) return TRUE;

Write_Data[0]=0x81; // читаем тек счетчик и сравниваем c Cur_Count
Write_Data[1]=0;
Write_Data[2]=0xd6;
Write_Data[3]=0;
Write_Data[4]=0;
Write_Data[5]=0;
Write_Data[6]=1;

if (!Send_Pack(Write_Data,Read_Data)) return FALSE;
Ready = Read_Data[6];
if (Ready!=Cur_Count)  //  можно считывать данные  
{
Cur_Count=Ready;
Write_Data[0]=0xe1; // читаем
Write_Data[1]=0;
Write_Data[2]=0xdb;
Write_Data[3]=0;
Write_Data[4]=0;
Write_Data[5]=0;
Write_Data[6]=0;
if (!Send_Pack(Write_Data,Read_Data)) return FALSE;
W=Read_Data[5];
W&=0x0f;
W<<=8; 
W+=Read_Data[6];
*Data_ADC_2 = (int)(((double)W - BSig)/(ASig-BSig)*4000);
W=Read_Data[3];
W&=0x0f;
W<<=8; 
W+=Read_Data[4];
*Data_ADC_1 = (int)(((double)W - BRef)/(ARef-BRef)*4000); 
sprintf(SSS," ADC_1 = %d ADC_2 = %d ",*Data_ADC_1,*Data_ADC_2);
WriteLog(SSS);
return TRUE;
}
else // Ready = Cur_Count
{
if (YesStop) return TRUE; 
goto loop;
}
}
BOOL White_End_Pause(byte *Cur_Count)
{
int W;
byte Ready;
loop:
if (YesStop) return TRUE;
Write_Data[0]=0x81; // читаем тек счетчик и сравниваем c Cur_Count
Write_Data[1]=0;
Write_Data[2]=0xd6;
Write_Data[3]=0;
Write_Data[4]=0;
Write_Data[5]=0;
Write_Data[6]=1;
if (!Send_Pack(Write_Data,Read_Data)) return FALSE;
Ready = Read_Data[6];
if (Ready==*Cur_Count) 
{
//----------------------------------------------- надо ли что то делать 
goto loop;    //  можно считывать данные  
}
else // Ready! = Cur_Count
{

*Cur_Count=Ready;
    
    return TRUE; 
}
}

Код


void TabWindow::on_expButton_clicked() //функция эксперимента
{
    //открытие и установка параметром Com порта
    com1->open(QIODevice::ReadWrite);
    com1->setFlowControl(QSerialPort::NoFlowControl);
    com1->setBaudRate(QSerialPort::Baud115200);
    com1->setStopBits(QSerialPort::OneStop);
    com1->setDataBits(QSerialPort::Data8);
    com1->setDataTerminalReady(false);
    com1->clear();

    //Experiment writepack 2
    expWrite2.resize(9);
    expWrite2[0] = 0x55;
    expWrite2[1] = 0x81;
    expWrite2[2] = 0;
    expWrite2[3] = 0xc2;
    expWrite2[4] = 0;
    expWrite2[5] = 0;
    expWrite2[6] = 0;
    expWrite2[7] = 0;
    expWrite2[8] = expWrite2[1];
    for (int i=2; i<8; i++)
        expWrite2[8]=expWrite2[8]+expWrite2[i];

    //Experiment readpack 1
    expRead1.resize(9);
    expRead1[0] = 0x55;
    expRead1[1] = 0x81;
    expRead1[2] = 0;
    expRead1[3] = 0xD6;
    expRead1[4] = 0;
    expRead1[5] = 0;
    expRead1[6] = 0;
    expRead1[7] = 1;
    expRead1[8] = expRead1[1];
    for (int i=2; i<8; i++)
        expRead1[8]=expRead1[8]+expRead1[i];

    //Experiment readpack 2
    expRead2.resize(9);
    expRead2[0] = 0x55;
    expRead2[1] = 0xE1;
    expRead2[2] = 0;
    expRead2[3] = 0xDB;
    expRead2[4] = 0;
    expRead2[5] = 0;
    expRead2[6] = 0;
    expRead2[7] = 0;
    expRead2[8] = expRead2[1];
    for (int i=2; i<8; i++)
        expRead2[8]=expRead2[8]+expRead2[i];

    ARef = 4000;
    BRef = 0;
    ASig = 4000;
    BSig = 0;
    QFile adcFile("ADC data.csv");

    expResult.resize(9);
    expResultP.resize(9);
    
    //запись байтов по адресу 0xC2 для начала стадии считывания данных
    com1->write(expWrite1);
    com1->waitForBytesWritten(50);
    com1->waitForReadyRead(50);
    expResult = com1->readAll();

    //с данной строки логи отправляемые и получаемые в ответ 
    //программой на С++ не совпадают с логами на Си 
    //Ошибка в том что с данной строки цикл должен повторятся и привязываться к тому что условие выполнения цикла 
    //это то что в ответном байте от блока по адресу 0хd6 8 бит с каждым шагом цикла увеличивается на 1цу в 16 системе 
    int count=0;
    expSignal[0]=count;
    while ((int)expSignal[0]<14)
    {
    com1->write(expWrite2);
    com1->waitForBytesWritten(50);
    com1->waitForReadyRead(50);
    expResult = com1->readAll();
    //expSignal[0]=count+1;

    //отправление байта для проверки можно ли проводить считывание по адресу 0хd6
    flag1:
    com1->write(expRead1);
    com1->waitForBytesWritten(100);
    com1->waitForReadyRead(100);
    expResultP = com1->readAll();
    expSignal[0] = expResultP[7];
    if ((int)expSignal[0]!=(int)expSignal[0]+1) goto flag1;
    else goto flag2;

    //если прошлый байт изменился в 8 бите на 1, считываем данные
    flag2:
    com1->write(expRead2);
    com1->waitForBytesWritten(100);
    com1->waitForReadyRead(100);
    expResult = com1->readAll();

    //операции преобразования полученных данных
        expRes1 = 0;
        expRes1 = expResult[4];
        expRes1 = expRes1 & 0xf;
        expRes1 = expRes1 << 8;
        expRes1 = expRes1 + expResult[5];
        expRes1 = (((double)expRes1 - BRef) / (ARef - BRef) * 4000);
        expRes2 = 0;
        expRes2 = expResult[6];
        expRes2 = expRes2 & 0xf;
        expRes2 = expRes2 << 8;
        expRes2 = expRes2 + expResult[7];
        expRes2 = (((double)expRes2 - BSig) / (ASig - BSig) * 4000);

        ADC1.resize(count+1);
        ADC2.resize(count+1);
        ADC1[count]=expRes1;
        ADC2[count]=expRes2;
        count++;
}
         com1->clear();
         com1->close();
}