trunk/H7%20Server/H7Serial.cpp

#include "StdAfx.h"
#include ".\h7serial.h"

CH7Serial::CH7Serial(void)
: CSlipSerial()
{
}

CH7Serial::CH7Serial(char* port, int bitrate)
: CSlipSerial(port, bitrate)
{
}

CH7Serial::~CH7Serial(void)
{
}

short CH7Serial::readTarget(unsigned char target)
{
        short retval;
        unsigned char frame[1];
        unsigned char hi_target = (target & 0x0F) << 4;
        frame[0] = hi_target | 0x00;

        writeFrame(frame,1);
        Sleep(200); //be nice and wait a little
        std::vector<unsigned char> answer = readFrame();

        if (answer.size() == 0)
                throw std::exception("No reply");

        if ( (answer[0] & 0x0F) != 0x02) // tjek for ACK 
                throw std::exception("Request not acknowledged");

        if ( (answer[0] & 0xF0) != hi_target)
                throw std::exception("Incorrect reply");

        if (answer.size() == 2)
                retval = answer[1];
        else if (answer.size() == 3)
                retval = (answer[1]<<8) | answer[2];
        else
                retval = -1;

        return retval;
}

void CH7Serial::writeTarget(unsigned char target, unsigned char data)
{
        unsigned char frame[2];
        unsigned char hi_target = (target & 0x0F) << 4;
        frame[0] = hi_target | 0x01;
        frame[1] = data;

        writeFrame(frame,2);
        Sleep(50); //be nice and wait a little
        std::vector<unsigned char> answer = readFrame();

        if (answer.size() == 0)
                throw std::exception("No reply");

        if ( (answer[0] & 0x0F) != 0x02) // tjek for ACK 
                throw std::exception("Request not acknowledged");

        if ( (answer[0] & 0xF0) != hi_target)
                throw std::exception("Incorrect reply");
}


1	#include "StdAfx.h"
2	#include ".\h7serial.h"
3
4	CH7Serial::CH7Serial(void)
5	: CSlipSerial()
6	{
7	}
8
9	CH7Serial::CH7Serial(char* port, int bitrate)
10	: CSlipSerial(port, bitrate)
11	{
12	}
13
14	CH7Serial::~CH7Serial(void)
15	{
16	}
17
18	short CH7Serial::readTarget(unsigned char target)
19	{
20	short retval;
21	unsigned char frame[1];
22	unsigned char hi_target = (target & 0x0F) << 4;
23	frame[0] = hi_target \| 0x00;
24
25	writeFrame(frame,1);
26	Sleep(200); //be nice and wait a little
27	std::vector<unsigned char> answer = readFrame();
28
29	if (answer.size() == 0)
30	throw std::exception("No reply");
31
32	if ( (answer[0] & 0x0F) != 0x02) // tjek for ACK
33	throw std::exception("Request not acknowledged");
34
35	if ( (answer[0] & 0xF0) != hi_target)
36	throw std::exception("Incorrect reply");
37
38	if (answer.size() == 2)
39	retval = answer[1];
40	else if (answer.size() == 3)
41	retval = (answer[1]<<8) \| answer[2];
42	else
43	retval = -1;
44
45	return retval;
46	}
47
48	void CH7Serial::writeTarget(unsigned char target, unsigned char data)
49	{
50	unsigned char frame[2];
51	unsigned char hi_target = (target & 0x0F) << 4;
52	frame[0] = hi_target \| 0x01;
53	frame[1] = data;
54
55	writeFrame(frame,2);
56	Sleep(50); //be nice and wait a little
57	std::vector<unsigned char> answer = readFrame();
58
59	if (answer.size() == 0)
60	throw std::exception("No reply");
61
62	if ( (answer[0] & 0x0F) != 0x02) // tjek for ACK
63	throw std::exception("Request not acknowledged");
64
65	if ( (answer[0] & 0xF0) != hi_target)
66	throw std::exception("Incorrect reply");
67	}
68
69