| 1 | 3 | sergeykhbr | /** Example:
 | 
      
         | 2 |  |  | * http://www.linux-tutorial.info/modules.php?name=Howto&pagename=Serial-Programming-HOWTO/x115.html#AEN125
 | 
      
         | 3 |  |  | */
 | 
      
         | 4 |  |  | #include "api_types.h"
 | 
      
         | 5 |  |  | #include "api_core.h"
 | 
      
         | 6 |  |  | #include "attribute.h"
 | 
      
         | 7 |  |  | #include "comport.h"
 | 
      
         | 8 |  |  |  
 | 
      
         | 9 |  |  | #include <stdlib.h>
 | 
      
         | 10 |  |  | #include <dirent.h>
 | 
      
         | 11 |  |  | #include <stdio.h>          // standard input/output
 | 
      
         | 12 |  |  | #include <sys/types.h>
 | 
      
         | 13 |  |  | #include <sys/stat.h>
 | 
      
         | 14 |  |  | #include <unistd.h>         // unix standard function definition
 | 
      
         | 15 |  |  | #include <string.h>         // strcpy, memset, memcpy
 | 
      
         | 16 |  |  | #include <fcntl.h>          // file control definition
 | 
      
         | 17 |  |  | #include <termios.h>        // POSIX terminal control definition
 | 
      
         | 18 |  |  | #include <errno.h>          // error number definition
 | 
      
         | 19 |  |  | #include <sys/ioctl.h>
 | 
      
         | 20 |  |  | #include <linux/serial.h>
 | 
      
         | 21 |  |  |  
 | 
      
         | 22 |  |  | #include <iostream>
 | 
      
         | 23 |  |  | #include <list>
 | 
      
         | 24 |  |  |  
 | 
      
         | 25 |  |  | namespace debugger {
 | 
      
         | 26 |  |  |  
 | 
      
         | 27 |  |  | using namespace std;
 | 
      
         | 28 |  |  |  
 | 
      
         | 29 |  |  | static std::string checkDriverPresence(const std::string& tty) {
 | 
      
         | 30 |  |  |     struct stat st;
 | 
      
         | 31 |  |  |     std::string devicedir = tty;
 | 
      
         | 32 |  |  |  
 | 
      
         | 33 |  |  |     // Append '/device' to the tty-path
 | 
      
         | 34 |  |  |     devicedir += "/device";
 | 
      
         | 35 |  |  |  
 | 
      
         | 36 |  |  |     // Stat the devicedir and handle it if it is a symlink
 | 
      
         | 37 |  |  |     if (lstat(devicedir.c_str(), &st)==0 && S_ISLNK(st.st_mode)) {
 | 
      
         | 38 |  |  |         char buffer[1024];
 | 
      
         | 39 |  |  |         memset(buffer, 0, sizeof(buffer));
 | 
      
         | 40 |  |  |  
 | 
      
         | 41 |  |  |         // Append '/driver' and return basename of the target
 | 
      
         | 42 |  |  |         devicedir += "/driver";
 | 
      
         | 43 |  |  |  
 | 
      
         | 44 |  |  |         if (readlink(devicedir.c_str(), buffer, sizeof(buffer)) > 0)
 | 
      
         | 45 |  |  |             return basename(buffer);
 | 
      
         | 46 |  |  |     }
 | 
      
         | 47 |  |  |     return "";
 | 
      
         | 48 |  |  | }
 | 
      
         | 49 |  |  |  
 | 
      
         | 50 |  |  | /*static void register_comport(list<string>& comList,
 | 
      
         | 51 |  |  |                                list<string>& comList8250,
 | 
      
         | 52 |  |  |                                const string& dir) {
 | 
      
         | 53 |  |  |     // Get the driver the device is using
 | 
      
         | 54 |  |  |     std::string driver = checkDriverPresence(dir);
 | 
      
         | 55 |  |  |  
 | 
      
         | 56 |  |  |     // Skip devices without a driver
 | 
      
         | 57 |  |  |     if (driver.size() > 0) {
 | 
      
         | 58 |  |  |         string devfile = string("/dev/") + basename(dir.c_str());
 | 
      
         | 59 |  |  |  
 | 
      
         | 60 |  |  |         // Put serial8250-devices in a seperate list
 | 
      
         | 61 |  |  |         if (driver == "serial8250") {
 | 
      
         | 62 |  |  |             comList8250.push_back(devfile);
 | 
      
         | 63 |  |  |         } else
 | 
      
         | 64 |  |  |             comList.push_back(devfile);
 | 
      
         | 65 |  |  |     }
 | 
      
         | 66 |  |  | }
 | 
      
         | 67 |  |  |  
 | 
      
         | 68 |  |  | static void probe_serial8250_comports(list<string>& comList,
 | 
      
         | 69 |  |  |                                       list<string> comList8250) {
 | 
      
         | 70 |  |  |     struct serial_struct serinfo;
 | 
      
         | 71 |  |  |     list<string>::iterator it = comList8250.begin();
 | 
      
         | 72 |  |  |  
 | 
      
         | 73 |  |  |     // Iterate over all serial8250-devices
 | 
      
         | 74 |  |  |     while (it != comList8250.end()) {
 | 
      
         | 75 |  |  |  
 | 
      
         | 76 |  |  |         // Try to open the device
 | 
      
         | 77 |  |  |         int fd = open((*it).c_str(), O_RDWR | O_NONBLOCK | O_NOCTTY);
 | 
      
         | 78 |  |  |  
 | 
      
         | 79 |  |  |         if (fd >= 0) {
 | 
      
         | 80 |  |  |             // Get serial_info
 | 
      
         | 81 |  |  |             if (ioctl(fd, TIOCGSERIAL, &serinfo)==0) {
 | 
      
         | 82 |  |  |                 // If device type is no PORT_UNKNOWN we accept the port
 | 
      
         | 83 |  |  |                 if (serinfo.type != PORT_UNKNOWN)
 | 
      
         | 84 |  |  |                     comList.push_back(*it);
 | 
      
         | 85 |  |  |             }
 | 
      
         | 86 |  |  |             close(fd);
 | 
      
         | 87 |  |  |         }
 | 
      
         | 88 |  |  |         it ++;
 | 
      
         | 89 |  |  |     }
 | 
      
         | 90 |  |  | }*/
 | 
      
         | 91 |  |  |  
 | 
      
         | 92 |  |  | /*
 | 
      
         | 93 |  |  |  * Enumerate all files in /sys/class/tty
 | 
      
         | 94 |  |  |  *
 | 
      
         | 95 |  |  |  * For each directory /sys/class/tty/foo, check if /sys/class/tty/foo/device
 | 
      
         | 96 |  |  |  * exists using lstat().
 | 
      
         | 97 |  |  |  *
 | 
      
         | 98 |  |  |  * If it does not exist then you are dealing with some kind of virtual tty
 | 
      
         | 99 |  |  |  * device (virtual console port, ptmx, etc...) and you can discard it.
 | 
      
         | 100 |  |  |  * If it exists then retain serial port foo.
 | 
      
         | 101 |  |  |  */
 | 
      
         | 102 |  |  | void ComPortService::getSerialPortList(AttributeType *list) {
 | 
      
         | 103 |  |  |     int n;
 | 
      
         | 104 |  |  |     struct dirent **namelist;
 | 
      
         | 105 |  |  |     const char* sysdir = "/sys/class/tty/";
 | 
      
         | 106 |  |  |     AttributeType jsonPortInfo;
 | 
      
         | 107 |  |  |     list->make_list(0);
 | 
      
         | 108 |  |  |  
 | 
      
         | 109 |  |  |     // Scan through /sys/class/tty - it contains all tty-devices in the system
 | 
      
         | 110 |  |  |     n = scandir(sysdir, &namelist, NULL, NULL);
 | 
      
         | 111 |  |  |     if (n < 0) {
 | 
      
         | 112 |  |  |         RISCV_error("Can't scan '%s' directory", sysdir);
 | 
      
         | 113 |  |  |         return;
 | 
      
         | 114 |  |  |     }
 | 
      
         | 115 |  |  |     while (n--) {
 | 
      
         | 116 |  |  |         if (!strcmp(namelist[n]->d_name, "..")
 | 
      
         | 117 |  |  |          || !strcmp(namelist[n]->d_name, ".")) {
 | 
      
         | 118 |  |  |             free(namelist[n]);
 | 
      
         | 119 |  |  |             continue;
 | 
      
         | 120 |  |  |         }
 | 
      
         | 121 |  |  |  
 | 
      
         | 122 |  |  |         // Construct full absolute file path
 | 
      
         | 123 |  |  |         std::string devicedir = sysdir;
 | 
      
         | 124 |  |  |         devicedir += namelist[n]->d_name;
 | 
      
         | 125 |  |  |  
 | 
      
         | 126 |  |  |         // Get the driver the device is using.
 | 
      
         | 127 |  |  |         // Skip devices without a driver
 | 
      
         | 128 |  |  |         std::string driver = checkDriverPresence(devicedir);
 | 
      
         | 129 |  |  |         if (driver.size() <= 0) {
 | 
      
         | 130 |  |  |             continue;
 | 
      
         | 131 |  |  |         }
 | 
      
         | 132 |  |  |         std::string devfile = std::string("/dev/") + basename(devicedir.c_str());
 | 
      
         | 133 |  |  |  
 | 
      
         | 134 |  |  |         jsonPortInfo.make_dict();
 | 
      
         | 135 |  |  |         jsonPortInfo["id"] = AttributeType(devfile.c_str());
 | 
      
         | 136 |  |  |         list->add_to_list(&jsonPortInfo);
 | 
      
         | 137 |  |  |         free(namelist[n]);
 | 
      
         | 138 |  |  |     }
 | 
      
         | 139 |  |  |     free(namelist);
 | 
      
         | 140 |  |  |  
 | 
      
         | 141 |  |  |     // Only non-serial8250 has been added to comList without any further testing
 | 
      
         | 142 |  |  |     // serial8250-devices must be probe to check for validity
 | 
      
         | 143 |  |  |     //probe_serial8250_comports(comList, comList8250);
 | 
      
         | 144 |  |  | }
 | 
      
         | 145 |  |  |  
 | 
      
         | 146 |  |  |  
 | 
      
         | 147 |  |  | int ComPortService::openSerialPort(const char *port, int baud, void *hdl) {
 | 
      
         | 148 |  |  |     *((int *)hdl) = 0;
 | 
      
         | 149 |  |  |     int fd = open(port, O_RDWR | O_NOCTTY);// | O_NONBLOCK);// | O_NDELAY );
 | 
      
         | 150 |  |  |     //fcntl(fd, F_SETFL, fcntl(fd, F_GETFL) & ~O_NONBLOCK);
 | 
      
         | 151 |  |  |     if (fd < 0) {
 | 
      
         | 152 |  |  |         RISCV_error("fopen() failed", NULL);
 | 
      
         | 153 |  |  |         return -1;
 | 
      
         | 154 |  |  |     }
 | 
      
         | 155 |  |  |  
 | 
      
         | 156 |  |  |     struct termios options;
 | 
      
         | 157 |  |  |     memset(&options, 0, sizeof(options));
 | 
      
         | 158 |  |  |  
 | 
      
         | 159 |  |  |     /**
 | 
      
         | 160 |  |  |      *    struct termios {
 | 
      
         | 161 |  |  |      *        tcflag_t  c_iflag;       // input modes
 | 
      
         | 162 |  |  |      *        tcflag_t  c_oflag;       // output modes
 | 
      
         | 163 |  |  |      *        tcflag_t  c_cflag;       // control modes
 | 
      
         | 164 |  |  |      *        tcflag_t  c_lflag;       // local modes
 | 
      
         | 165 |  |  |      *        speed_t   c_ispeed;      // input speed
 | 
      
         | 166 |  |  |      *        speed_t   c_ospeed;      // output speed
 | 
      
         | 167 |  |  |      *        cc_t      c_cc[NCCS];    // control characters
 | 
      
         | 168 |  |  |      *    };
 | 
      
         | 169 |  |  |      * Input flags c_iflags:
 | 
      
         | 170 |  |  |      *    ICRNL  - map CR to NL on input (NL = LF)
 | 
      
         | 171 |  |  |      *    IGNCR  - ignore CR
 | 
      
         | 172 |  |  |      *    INLCR  - map NL to CR
 | 
      
         | 173 |  |  |      *    IXON   - enable start/stop output control
 | 
      
         | 174 |  |  |      *    IXOFF  - enable start/stop input control
 | 
      
         | 175 |  |  |      *    IXANY  - allow any character to restart output
 | 
      
         | 176 |  |  |      *    ISTRIP - strip character to seven bits
 | 
      
         | 177 |  |  |      *    IGNPAR - ignore characters withparity error
 | 
      
         | 178 |  |  |      *    INPCK  - enable input parity checking
 | 
      
         | 179 |  |  |      *    PARMRK - mark parity error by inserting '\377', '\0'
 | 
      
         | 180 |  |  |      *    BRKINT - send SIGINT to the terminal when receiving break condition
 | 
      
         | 181 |  |  |      *    IGNBRK - ignore break condition
 | 
      
         | 182 |  |  |      */
 | 
      
         | 183 |  |  |     options.c_iflag = IGNPAR;
 | 
      
         | 184 |  |  |  
 | 
      
         | 185 |  |  |     /* Output mode c_oflag:
 | 
      
         | 186 |  |  |      *    OPOST  - perform output processing
 | 
      
         | 187 |  |  |      *    ONCLR  - transform NL to CR NL
 | 
      
         | 188 |  |  |      *    XTABS  - Transform TAB into spaces
 | 
      
         | 189 |  |  |      *    ONOEOT - discard EOT (^D) character
 | 
      
         | 190 |  |  |      */
 | 
      
         | 191 |  |  |     options.c_oflag = 0;          //
 | 
      
         | 192 |  |  |  
 | 
      
         | 193 |  |  |     /* Control modes c_cflag:
 | 
      
         | 194 |  |  |      *    CLOCAL - ignore modem status lines
 | 
      
         | 195 |  |  |      *    CREAD  - enable receiver
 | 
      
         | 196 |  |  |      *    CSIZE  - number of bits mask. Possible values: CS5, CS6, CS7, CS8
 | 
      
         | 197 |  |  |      *    CSTOPB - send 2 stop bits instead of one.
 | 
      
         | 198 |  |  |      *    PARENB - enable parity generation
 | 
      
         | 199 |  |  |      *    PARODD - generate odd parity if parity is generated
 | 
      
         | 200 |  |  |      *    HUPCL  - drop modem control lines on the last close of the terminal line
 | 
      
         | 201 |  |  |      */
 | 
      
         | 202 |  |  |     options.c_cflag = B115200 | CRTSCTS | CS8 | CLOCAL | CREAD;
 | 
      
         | 203 |  |  |  
 | 
      
         | 204 |  |  |     /* Local modes c_lflag:
 | 
      
         | 205 |  |  |      *    ECHO   - enable echoing of input characters
 | 
      
         | 206 |  |  |      *    ECHOE  - if ICANNON an ECHO are set then echo ERASE and KILL as one
 | 
      
         | 207 |  |  |      *             or more backspace-space-backspace sequences (to wipe entire
 | 
      
         | 208 |  |  |      *             line)
 | 
      
         | 209 |  |  |      *    ECHOK  - output an NL after the KILL character
 | 
      
         | 210 |  |  |      *    ECHONL - echo NL even if ECHO is not set
 | 
      
         | 211 |  |  |      *    ICANON - cannonical input. This enables line oriented input (not raw case).
 | 
      
         | 212 |  |  |      *    IEXTEN - enable implementation defined input extensions
 | 
      
         | 213 |  |  |      *    ISIG   - enable signal character INTR, QUIT, SUSP
 | 
      
         | 214 |  |  |      *    NOFLSH - disable flushing of the input/output queues that is normally
 | 
      
         | 215 |  |  |      *             done if a signal is sent
 | 
      
         | 216 |  |  |      *    TOSTOP - send a SIGTTOU if job control is implemented
 | 
      
         | 217 |  |  |      */
 | 
      
         | 218 |  |  |     options.c_lflag = 0;          // no signaling chars, no echo
 | 
      
         | 219 |  |  |  
 | 
      
         | 220 |  |  |     /* Available fields:
 | 
      
         | 221 |  |  |      *    VEOF, VEOL, VERASE, VINTR, VKILL, VMIN, VQUIT, VTIME, VSUSP, VSTART,
 | 
      
         | 222 |  |  |      *    VSTOP, VREPRINT, VLNEXT and VDISCARD
 | 
      
         | 223 |  |  |      */
 | 
      
         | 224 |  |  |     options.c_cc[VTIME] = 0;      // inter-character timer unesed
 | 
      
         | 225 |  |  |     options.c_cc[VMIN] = 0;       // blocking read until 5 chars received
 | 
      
         | 226 |  |  |  
 | 
      
         | 227 |  |  |  
 | 
      
         | 228 |  |  |     tcflush(fd, TCIOFLUSH);
 | 
      
         | 229 |  |  |     // TCSANOW   - change occurs immediatly
 | 
      
         | 230 |  |  |     // TCSADRAIN - change occurs after all parameters are written
 | 
      
         | 231 |  |  |     // TCSAFLUSH - ..
 | 
      
         | 232 |  |  |     if(tcsetattr(fd, TCSANOW, &options) == -1) {
 | 
      
         | 233 |  |  |         RISCV_error("tcsetattr() failed", NULL);
 | 
      
         | 234 |  |  |         return -1;
 | 
      
         | 235 |  |  |     }
 | 
      
         | 236 |  |  |  
 | 
      
         | 237 |  |  |     // Empty buffers
 | 
      
         | 238 |  |  |     tcflush(fd, TCIOFLUSH);
 | 
      
         | 239 |  |  |     *((int *)hdl) = fd;
 | 
      
         | 240 |  |  |     return 0 ;
 | 
      
         | 241 |  |  | }
 | 
      
         | 242 |  |  |  
 | 
      
         | 243 |  |  | void ComPortService::closeSerialPort(void *hdl) {
 | 
      
         | 244 |  |  |     close(*((int *)hdl));
 | 
      
         | 245 |  |  | }
 | 
      
         | 246 |  |  |  
 | 
      
         | 247 |  |  | int ComPortService::readSerialPort(void *hdl, char *buf, int bufsz) {
 | 
      
         | 248 |  |  |     return read(*((int *)hdl), buf, bufsz-1);
 | 
      
         | 249 |  |  | }
 | 
      
         | 250 |  |  |  
 | 
      
         | 251 |  |  | int ComPortService::writeSerialPort(void *hdl, char *buf, int bufsz) {
 | 
      
         | 252 |  |  |     return write(*((int *)hdl), buf, bufsz);
 | 
      
         | 253 |  |  | }
 | 
      
         | 254 |  |  |  
 | 
      
         | 255 |  |  | void ComPortService::cleanSerialPort(void *hdl) {
 | 
      
         | 256 |  |  |     tcflush(*((int *)hdl), TCIOFLUSH);
 | 
      
         | 257 |  |  | }
 | 
      
         | 258 |  |  |  
 | 
      
         | 259 |  |  | }  // namespace debugger
 |