1 |
|
|
2 |
|
#ifdef _WINDOWS |
3 |
#include "StdAfx.h" |
#include "StdAfx.h" |
4 |
#include ".\h7serial.h" |
#endif |
5 |
|
|
6 |
|
#include "H7Serial.h" |
7 |
|
#include <stdexcept> |
8 |
|
|
9 |
CH7Serial::CH7Serial(void) |
CH7Serial::CH7Serial(void) |
10 |
: CSlipSerial() |
: CSlipSerial() |
32 |
std::vector<unsigned char> answer = readFrame(); |
std::vector<unsigned char> answer = readFrame(); |
33 |
|
|
34 |
if (answer.size() == 0) |
if (answer.size() == 0) |
35 |
throw std::exception("No reply"); |
throw std::runtime_error("No reply"); |
36 |
|
|
37 |
if ( (answer[0] & 0x0F) != 0x02) // tjek for ACK |
if ( (answer[0] & 0x0F) != 0x02) // tjek for ACK |
38 |
throw std::exception("Request not acknowledged"); |
throw std::runtime_error("Request not acknowledged"); |
39 |
|
|
40 |
if ( (answer[0] & 0xF0) != hi_target) |
if ( (answer[0] & 0xF0) != hi_target) |
41 |
throw std::exception("Incorrect reply"); |
throw std::runtime_error("Incorrect reply"); |
42 |
|
|
43 |
if (answer.size() == 2) |
if (answer.size() == 2) |
44 |
retval = answer[1]; |
retval = answer[1]; |
62 |
std::vector<unsigned char> answer = readFrame(); |
std::vector<unsigned char> answer = readFrame(); |
63 |
|
|
64 |
if (answer.size() == 0) |
if (answer.size() == 0) |
65 |
throw std::exception("No reply"); |
throw std::runtime_error("No reply"); |
66 |
|
|
67 |
if ( (answer[0] & 0x0F) != 0x02) // tjek for ACK |
if ( (answer[0] & 0x0F) != 0x02) // tjek for ACK |
68 |
throw std::exception("Request not acknowledged"); |
throw std::runtime_error("Request not acknowledged"); |
69 |
|
|
70 |
if ( (answer[0] & 0xF0) != hi_target) |
if ( (answer[0] & 0xF0) != hi_target) |
71 |
throw std::exception("Incorrect reply"); |
throw std::runtime_error("Incorrect reply"); |
72 |
} |
} |
73 |
|
|
74 |
|
|