Пример #1
0
int CQboduinoDriver::getVersion(std::string board, int& board_number, int& version)
{
    CComando comand=comandosSet_.version;
    std::vector<dataUnion> data, sent;
    int code=sendComand(board,comand,data,sent);
    if (code<0) return code;
    board_number=(int)data[0].b;
    version=(int)data[1].b;
    return code;
}
Пример #2
0
BYTE sendSavePower(void)
{
    BYTE i;
    BYTE buffer[5];
    sendComand(save_power_cmd, 7);
    if(!getBuffer(buffer, 5)) return 0;
    for(i = 0; i<5; i++)
        if(buffer[i]!= save_power_rcv[i]) return 0;
    return 1;
}
Пример #3
0
BYTE sendZoomSize(void)
{
    BYTE i;
    BYTE buffer[5];
#ifdef ZOOM_SIZE
    sendComand(zoom_size_cmd, 6);
#endif
    if(!getBuffer(buffer, 5)) return 0;
    for(i = 0; i<5; i++)
        if(buffer[i]!= zoom_size_rcv[i]) return 0;
    return 1;
}
Пример #4
0
// reset cmr
BYTE sendReset(void){
    BYTE buffer[50];
    WORD i = 0;
      UART1PutROMString("start\n");
    sendComand(reset_cmd, 5);
    getCommand(buffer,10);

    for( i =0; i<4; i++){
        if(buffer[i]!= reset_rcv[i]) return 0;
      }
    UART1PutROMString("end");
    return 1;
    }
Пример #5
0
int CQboduinoDriver::lockAndSendComand(std::string board, CComando& comand, std::vector<dataUnion>& response, std::vector<dataUnion>& data)
{
    int code=-3;
    if(boards_.count(board)==0) return -2;
    if(board.compare("base")==0 && sending_data_mutex_.timed_lock(boost::posix_time::millisec(500)))
    {
        code=sendComand(board,comand,response,data);
        sending_data_mutex_.unlock();
        return code;
    }
    else
        code=-3;
    if(board.compare("head")==0 && sending_data_head_mutex_.timed_lock(boost::posix_time::millisec(500)))
    {
        code=sendComand(board,comand,response,data);
        sending_data_head_mutex_.unlock();
        return code;
    }
    else
        code=-3;
    std::cout << "Mutex timeout" << std::endl;
    return code;
}
Пример #6
0
BYTE setBaudRate(void)
{
    BYTE i;
    BYTE buffer[5];
    sendComand(set_bps_cmd, 7);


    if(!getBuffer(buffer, 5)) return 0;
    for(i = 0; i<5; i++)
        if(buffer[i]!= set_bps_rcv[i]) return 0;


    return 1;

}
Пример #7
0
BYTE sendStopPhoto(void){
    BYTE i;
    BYTE buffer[5];

    sendComand(stop_photo_cmd, 5);
    if(!getCommand(buffer, 5)) return 0;
    for(i = 0; i<5; i++)

        if(buffer[i]!=stop_photo_rcv[i]){

            return 0;
        }

    return 1;
}
Пример #8
0
BYTE sendCompressRate(void){
    BYTE i;
    BYTE buffer[5];

     sendComand(compress_rate_cmd, 9);
    if(!getCommand(buffer, 5)) return 0;
    for(i = 0; i<5; i++){

        if(buffer[i]!= compress_rate_rcv[i]){

            return 0;
        }
    }

    return 1;

}
Пример #9
0
BYTE sendStartPhoto(void){
    BYTE buffer[5];
    BYTE i = 0;

    sendComand(start_photo_cmd, 10);
    if(!getCommand(buffer, 5)) return 0;
    for(i = 0; i<5; i++){

        if(buffer[i]!= start_photo_rcv[i]){

            return 0;
        }

    }

    return 1;
}
Пример #10
0
BYTE sendPhotoSize(void)
{
    BYTE i;
    BYTE buffer[5];

    sendComand(photo_size_cmd, 10);
    if(!getCommand(buffer, 5)){
        return 0;
    }
    for(i = 0; i<5; i++)

        if(buffer[i] !=photo_size_rcv[i]){

            return 0;

        }

    return 1;
}
Пример #11
0
BYTE sendGetLength(void){
    BYTE buffer[7];
    BYTE i = 0;

    sendComand(read_len_cmd, 5);
    if(!getCommand(buffer, 9)) return 0;
    for(i = 0; i<7; i++){

        if(buffer[i]!=read_len_rcv[i]){

            return 0;
             }
    }
    setPhotoLen(buffer[7], buffer[8]);

    for(i = 0; i<9; i++){

         }

    return 1;
}