1 |
|
|
2 |
#ifdef _WINDOWS |
#include "stdafx.h" |
|
#include "StdAfx.h" |
|
|
#endif |
|
3 |
|
|
4 |
#include "H7Serial.h" |
#include "H7Serial.h" |
5 |
#include <stdexcept> |
#include <stdexcept> |
6 |
|
#include <iostream> |
7 |
|
|
8 |
CH7Serial::CH7Serial(void) |
CH7Serial::CH7Serial(void) |
9 |
: CSlipSerial() |
: CSlipSerial() |
10 |
{ |
{ |
11 |
} |
} |
12 |
|
|
13 |
CH7Serial::CH7Serial(char* port, int bitrate) |
CH7Serial::CH7Serial(char* port, Baudrate bitrate) |
14 |
: CSlipSerial(port, bitrate) |
: CSlipSerial(port, bitrate) |
15 |
{ |
{ |
16 |
} |
} |
21 |
|
|
22 |
short CH7Serial::readTarget(unsigned char target) |
short CH7Serial::readTarget(unsigned char target) |
23 |
{ |
{ |
24 |
|
using namespace std; |
25 |
|
cout << "read start" << endl; |
26 |
short retval; |
short retval; |
27 |
unsigned char frame[1]; |
unsigned char frame[1]; |
28 |
unsigned char hi_target = (target & 0x0F) << 4; |
unsigned char hi_target = (target & 0x0F) << 4; |
29 |
frame[0] = hi_target | 0x00; |
frame[0] = hi_target | 0x00; |
30 |
|
|
31 |
writeFrame(frame,1); |
writeFrame(frame,1); |
32 |
|
cout << "read mid" << endl; |
33 |
Sleep(50); //be nice and wait a little |
Sleep(50); //be nice and wait a little |
34 |
std::vector<unsigned char> answer = readFrame(); |
std::vector<unsigned char> answer = readFrame(); |
35 |
|
cout << "read done" << endl; |
36 |
|
|
37 |
if (answer.size() == 0) |
if (answer.size() == 0) |
38 |
throw std::runtime_error("No reply"); |
throw std::runtime_error("No reply"); |
55 |
|
|
56 |
void CH7Serial::writeTarget(unsigned char target, unsigned char data) |
void CH7Serial::writeTarget(unsigned char target, unsigned char data) |
57 |
{ |
{ |
58 |
|
using namespace std; |
59 |
unsigned char frame[2]; |
unsigned char frame[2]; |
60 |
unsigned char hi_target = (target & 0x0F) << 4; |
unsigned char hi_target = (target & 0x0F) << 4; |
61 |
frame[0] = hi_target | 0x01; |
frame[0] = hi_target | 0x01; |
62 |
frame[1] = data; |
frame[1] = data; |
63 |
|
cout << "write start" << endl; |
64 |
|
|
65 |
writeFrame(frame,2); |
writeFrame(frame,2); |
66 |
|
cout << "write mid" << endl; |
67 |
Sleep(50); //be nice and wait a little |
Sleep(50); //be nice and wait a little |
68 |
std::vector<unsigned char> answer = readFrame(); |
std::vector<unsigned char> answer = readFrame(); |
69 |
|
|
70 |
|
cout << "write stop" << endl; |
71 |
if (answer.size() == 0) |
if (answer.size() == 0) |
72 |
throw std::runtime_error("No reply"); |
throw std::runtime_error("No reply"); |
73 |
|
|