/[H7]/branches/linux-serial/Serial.cpp
ViewVC logotype

Diff of /branches/linux-serial/Serial.cpp

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 44 by torben, Sun Feb 4 21:22:44 2007 UTC revision 57 by torben, Mon Feb 5 10:38:58 2007 UTC
# Line 1  Line 1 
1  #ifdef _WINDOWS  #ifndef _MSC_VER //linux
2  #include "StdAfx.h"  #include <sys/types.h>
3  #else //linux  #include <sys/stat.h>
4    #include <unistd.h>
5  #include <errno.h>  #include <errno.h>
6    #include <termios.h>
7    #include <fcntl.h>
8  #endif  #endif
9    
 #include "Serial.h"  
10    
11  #include <stdexcept>  #include <stdexcept>
12  #include <string>  #include <string>
13  #include <sstream>  #include <sstream>
14    
15    #ifdef DEBUG
16    #include <iostream>
17  #include <iomanip>  #include <iomanip>
18    #endif
19    
20    #include "stdafx.h"
21    #include "Serial.h"
22    
23    
24  std::string writeLastError()  std::string writeLastError()
25  {  {
26  #ifdef _WINDOWS  #ifdef _MSC_VER
27          LPVOID lpMsgBuf;          LPVOID lpMsgBuf;
28          FormatMessage(FORMAT_MESSAGE_ALLOCATE_BUFFER|FORMAT_MESSAGE_FROM_SYSTEM|FORMAT_MESSAGE_IGNORE_INSERTS,          FormatMessage(FORMAT_MESSAGE_ALLOCATE_BUFFER|FORMAT_MESSAGE_FROM_SYSTEM|FORMAT_MESSAGE_IGNORE_INSERTS,
29                          NULL,                          NULL,
# Line 24  std::string writeLastError() Line 34  std::string writeLastError()
34                          NULL);                          NULL);
35    
36          std::ostringstream out;          std::ostringstream out;
37          out << "Error" << lpMsgBuf;          out << "Error " << lpMsgBuf;
38          return out.str();          return out.str();
39  #else //linux  #else //linux
40          char message[256];          return std::string( strerror(errno) );
         strerror_r(errno, message, 255);  
         return std::string(message);  
41  #endif  #endif
42  }  }
43    
# Line 39  CSerial::CSerial() Line 47  CSerial::CSerial()
47          mIsopen = false;          mIsopen = false;
48  }  }
49    
50  CSerial::CSerial(char* port, int bitrate)  
51    CSerial::CSerial(char* port, Baudrate bitrate)
52  {  {
53          mPortstr = port;          mPortstr = port;
54          mBitrate = bitrate;          mBitrate = bitrate;
55          mIsopen = false;          mIsopen = false;
56    
57  #ifdef _WINDOWS  #ifdef _MSC_VER
58          openWindows();          openWindows();
59  #else  #else
60          openLinux();          openLinux();
# Line 57  CSerial::~CSerial(void) Line 66  CSerial::~CSerial(void)
66          close();          close();
67  }  }
68    
69  void CSerial::open(char* port, int bitrate)  void CSerial::open(char* port, Baudrate bitrate)
70  {  {
71          if (mIsopen)          if (mIsopen)
72                  throw std::runtime_error("Port already opened");                  throw std::runtime_error("Port already opened");
# Line 65  void CSerial::open(char* port, int bitra Line 74  void CSerial::open(char* port, int bitra
74          mPortstr = port;          mPortstr = port;
75          mBitrate = bitrate;          mBitrate = bitrate;
76                    
77  #ifdef _WINDOWS  #ifdef _MSC_VER
78          openWindows();          openWindows();
79  #else  #else
80          openLinux();          openLinux();
81  #endif  #endif
82  }  }
83    
84  #ifdef _WINDOWS  #ifdef _MSC_VER
85  void CSerial::openWindows()  void CSerial::openWindows()
86  {  {
87          mComport = CreateFile( mPortstr, GENERIC_READ|GENERIC_WRITE,0,0,OPEN_EXISTING,FILE_ATTRIBUTE_NORMAL,0);          mComport = CreateFile( mPortstr, GENERIC_READ|GENERIC_WRITE,0,0,OPEN_EXISTING,FILE_ATTRIBUTE_NORMAL,0);
# Line 93  void CSerial::openWindows() Line 102  void CSerial::openWindows()
102                  throw std::exception(error.c_str());                  throw std::exception(error.c_str());
103          }          }
104    
105          dcb.BaudRate = mBitrate;          dcb.BaudRate = convertBaudrate(mBitrate);
106          dcb.ByteSize = 8;          dcb.ByteSize = 8;
107          dcb.Parity = NOPARITY;          dcb.Parity = NOPARITY;
108          dcb.StopBits = ONESTOPBIT;          dcb.StopBits = ONESTOPBIT;
# Line 106  void CSerial::openWindows() Line 115  void CSerial::openWindows()
115          {          {
116                  std::string error = writeLastError();                  std::string error = writeLastError();
117                  CloseHandle(mComport);                  CloseHandle(mComport);
118                  throw std::exception(error.c_str());                  throw std::runtime_error( error );
119          }          }
120    
121          mIsopen = true;          mIsopen = true;
# Line 114  void CSerial::openWindows() Line 123  void CSerial::openWindows()
123  #endif  #endif
124    
125    
126  #ifndef _WINDOWS  #ifndef _MSC_VER
127  void CSerial::openLinux()  void CSerial::openLinux()
128  {  {
129            termios newtio;
130    
131            mFiledescriptor = ::open(mPortstr, O_RDWR | O_NOCTTY | O_NONBLOCK);
132            if (mFiledescriptor < 0)
133                    throw std::runtime_error( writeLastError() );
134    
135            bzero(&newtio, sizeof(newtio) );
136    
137            // use a std. 8N1 config
138            newtio.c_cflag = convertBaudrate(mBitrate) | CRTSCTS | CS8 | CLOCAL | CREAD;
139            newtio.c_iflag = IGNPAR;
140            newtio.c_oflag = 0;
141    
142            // set input mode (non-canonical, no echo,...)
143            newtio.c_lflag = 0;
144                            
145            newtio.c_cc[VTIME]    = 0;   // inter-character timer unused
146            newtio.c_cc[VMIN]     = 0;   // blocking read until 1 chars received
147            
148                                            
149            tcflush(mFiledescriptor, TCIFLUSH);
150            tcsetattr(mFiledescriptor, TCSANOW, &newtio);
151            
152            mIsopen = true;
153  }  }
154  #endif  #endif
155    
# Line 124  void CSerial::close() Line 157  void CSerial::close()
157  {  {
158          if (mIsopen)          if (mIsopen)
159          {          {
160  #ifdef _WINDOWS  #ifdef _MSC_VER
161                  while (getComstat().cbOutQue >0)                  while (getComstat().cbOutQue >0)
162                          Sleep(5);                          Sleep(5);
163                  SetCommState(mComport,&mDcbRestore);                  SetCommState(mComport,&mDcbRestore);
164                  CloseHandle(mComport);                  CloseHandle(mComport);
165  #else // linux close()  #else // linux close()
166                    tcdrain(mFiledescriptor);
167                    tcsetattr(mFiledescriptor, TCSADRAIN, &mOldtio); //restore settings, when all data is written
168                    ::close(mFiledescriptor); //close()== system-call
169  #endif  #endif
170                  mIsopen = false;                  mIsopen = false;
171          }          }
172  }  }
173    
174    
175  unsigned char CSerial::readByte()  int CSerial::readByte()
176  {  {
177          unsigned char out;          unsigned char out;
178          unsigned long size;          unsigned long size;
179    
180          if (!mIsopen)          if (!mIsopen)
181                  throw std::runtime_error("Port not opened");                  throw std::runtime_error("Port not opened");
182  #ifdef _WINDOWS  #ifdef _MSC_VER
183          ReadFile(mComport,&out,1,&size,0);          ReadFile(mComport,&out,1,&size,0);
184          if (size != 1)          if (size != 1)
185          {          {
# Line 152  unsigned char CSerial::readByte() Line 188  unsigned char CSerial::readByte()
188                  throw std::exception(error.c_str());                  throw std::exception(error.c_str());
189          }          }
190  #else //linux readByte()  #else //linux readByte()
191            size = read(mFiledescriptor, &out, 1);
192            if (size != 1)
193            {
194                    return -1;
195            }
196  #endif  #endif
197    
198          //printByte("Read", out);          printByte("Read", out);
199          return out;          return out;
200  }  }
201    
# Line 163  void CSerial::writeByte(unsigned char ou Line 204  void CSerial::writeByte(unsigned char ou
204  {  {
205          unsigned long size;          unsigned long size;
206    
207          //printByte("Write", out);          printByte("Write", out);
208          if (!mIsopen)          if (!mIsopen)
209                  throw std::runtime_error("Port not opened");                  throw std::runtime_error("Port not opened");
210    
211  #ifdef _WINDOWS  #ifdef _MSC_VER
212          while (getComstat().cbOutQue >0)          while (getComstat().cbOutQue >0)
213                  Sleep(2);                  Sleep(2);
214    
# Line 179  void CSerial::writeByte(unsigned char ou Line 220  void CSerial::writeByte(unsigned char ou
220                  throw std::exception(error.c_str());                  throw std::exception(error.c_str());
221          }          }
222  #else //linux writeByte()  #else //linux writeByte()
223            //tcdrain(mFiledescriptor);
224            size = write(mFiledescriptor,&out,1);
225            Sleep(50);
226            //tcdrain(mFiledescriptor);
227            if (size != 1)
228                    throw std::runtime_error(writeLastError() );
229    #endif
230    }
231    
232    int CSerial::convertBaudrate(Baudrate rate)
233    {
234            int retval=0;
235    #ifdef _MSC_VER
236            switch( rate )
237            {
238                    case Baud300:
239                            retval = 300;
240                            break;
241                    case Baud600:
242                            retval = 600;
243                            break;
244                    case Baud1200:
245                            retval = 1200;
246                            break;
247                    case Baud2400:
248                            retval = 2400;
249                            break;
250                    case Baud4800:
251                            retval = 4800;
252                            break;
253                    case Baud9600:
254                            retval = 9600;
255                            break;
256                    case Baud19200:
257                            retval = 19200;
258                            break;
259                    case Baud38400:
260                            retval = 38400;
261                            break;
262                    case Baud57600:
263                            retval = 57600;
264                            break;
265                    case Baud115200:
266                            retval = 115200;
267                            break;                  
268            }
269    #else
270            switch (rate)
271            {
272                    case Baud300:
273                            retval = B300;
274                            break;
275                    case Baud600:
276                            retval = B600;
277                            break;
278                    case Baud1200:
279                            retval = B1200;
280                            break;
281                    case Baud2400:
282                            retval = B2400;
283                            break;
284                    case Baud4800:
285                            retval = B4800;
286                            break;
287                    case Baud9600:
288                            retval = B9600;
289                            break;
290                    case Baud19200:
291                            retval = B19200;
292                            break;
293                    case Baud38400:
294                            retval = B38400;
295                            break;
296                    case Baud57600:
297                            retval = B57600;
298                            break;
299                    case Baud115200:
300                            retval = B115200;
301                            break;
302            }
303  #endif  #endif
304    
305            return retval;
306  }  }
307  #ifdef _WINDOWS  
308    #ifdef _MSC_VER
309  COMSTAT CSerial::getComstat() const  COMSTAT CSerial::getComstat() const
310  {  {
311          if (!mIsopen)          if (!mIsopen)
# Line 196  COMSTAT CSerial::getComstat() const Line 320  COMSTAT CSerial::getComstat() const
320    
321  int CSerial::bytesReady() const  int CSerial::bytesReady() const
322  {  {
323  #ifdef _WINDOWS  #ifdef _MSC_VER
324          return getComstat().cbInQue;          return getComstat().cbInQue;
325  #else  #else
326          return 0;          return 0;
# Line 205  int CSerial::bytesReady() const Line 329  int CSerial::bytesReady() const
329    
330  int CSerial::outQueueSize() const  int CSerial::outQueueSize() const
331  {  {
332  #ifdef _WINDOWS  #ifdef _MSC_VER
333          return getComstat().cbOutQue;          return getComstat().cbOutQue;
334  #else  #else
335          return 0;          return 0;
336  #endif  #endif
337  }  }
338    
339  /* Debug function  // Debug function
340    //
341  void CSerial::printByte(char* description, unsigned char byte)  void CSerial::printByte(char* description, unsigned char byte)
342  {  {
343    #ifdef DEBUG
344          std::cout << description << " : " <<  (int) byte << "/" << std::setw(2) << std::setfill('0') << std::hex << (int) byte << std::endl;          std::cout << description << " : " <<  (int) byte << "/" << std::setw(2) << std::setfill('0') << std::hex << (int) byte << std::endl;
345          std::cout << std::dec;          std::cout << std::dec;
346    #endif
347  }  }
348  */  
349    
350  /*  /*
351  void CSerial::writeBytes(UCVector out)  void CSerial::writeBytes(UCVector out)
Legend:
Removed from v.44  
changed lines
  Added in v.57
  ViewVC Help
Powered by ViewVC 1.1.20