问如何检测驱动程序是否不支持ioctl命令TIOCSSERIAL

EN

#include <string.h>
#include <stdlib.h>
#include <stdio.h>
#include <errno.h>
#include <unistd.h>
#include <fcntl.h>
#include <termio.h>
#include <linux/serial.h>
#include <err.h>

#include "portutils.h"

static int rate_to_constant(int baudrate) {
#define B(x) case x: return B##x
        switch(baudrate) {
        B(50);     B(75);     B(110);    B(134);    B(150);
        B(200);    B(300);    B(600);    B(1200);   B(1800);
        B(2400);   B(4800);   B(9600);   B(19200);  B(38400);
        B(57600);  B(115200); B(230400); B(460800); B(500000);
        B(576000); B(921600); B(1000000);B(1152000);B(1500000);
    default: return 0;
    }
#undef B
}

int main(int argc, char** argv) {

    struct termios options;
    struct serial_struct serinfo;
    int fd;
    int speed = 0;
    int baudrate = 625000;
    char * port_name;

      // Check arguments for correct usage
    if (argc != 3){
        printf("\n  Usage: %s port baudrate!\n\n", argv[0]);
        return -1;
    }

    print_bar();

    baudrate = atoi(argv[2]);
    port_name = argv[1];

    /* Open and configure serial port */
    if ((fd = open(port_name, O_RDWR|O_NOCTTY)) == -1)
    {
        printf("\n  Could not open port %s\n", port_name);
        goto HELL;
    }

    printf("  Trying to set baud rate to %d\n  On port %s\n", baudrate, port_name);

    // if you've entered a standard baud the function below will return it
    speed = rate_to_constant(baudrate);

    if (speed == 0) {
        /* Custom divisor */
        serinfo.reserved_char[0] = 0;
        if (ioctl(fd, TIOCGSERIAL, &serinfo) < 0) {
            printf("\n  ioctl: Failed to get #1\n  serial line information of %s\n", port_name);
            goto HELL;
        }
        serinfo.flags &= ~ASYNC_SPD_MASK;
        serinfo.flags |= ASYNC_SPD_CUST;
        serinfo.custom_divisor = (serinfo.baud_base + (baudrate / 2)) / baudrate;
        if (serinfo.custom_divisor < 1) {
            serinfo.custom_divisor = 1;
        }
        printf("  Baud_base: %d\n", serinfo.baud_base);
        printf("  Devisor: %d\n", serinfo.custom_divisor);
        printf("  Resulting baudrate: %f\n", serinfo.baud_base/(1.0*serinfo.custom_divisor));        
        if (ioctl(fd, TIOCSSERIAL, &serinfo) < 0) {
            printf("\n  ioctl: Failed to set\n  serial line information of %s\n", port_name);
            goto HELL;

        }
        if (ioctl(fd, TIOCGSERIAL, &serinfo) < 0) {
            printf("\n  ioctl: Failed to get #2\n  serial line information of %s\n", port_name);
            goto HELL;
        }
        if (serinfo.custom_divisor * baudrate != serinfo.baud_base) {
            warnx("actual baudrate is %d / %d = %f",
                  serinfo.baud_base, serinfo.custom_divisor,
                  (float)serinfo.baud_base / serinfo.custom_divisor);
        }
    }

    fcntl(fd, F_SETFL, 0);
    tcgetattr(fd, &options);
    cfsetispeed(&options, speed ?: B38400);
    cfsetospeed(&options, speed ?: B38400);
    cfmakeraw(&options);
    options.c_cflag |= (CLOCAL | CREAD);
    options.c_cflag &= ~CRTSCTS;
    if (tcsetattr(fd, TCSANOW, &options) != 0)
    {
        printf("\n  Failed to set final attributes of %s\n\n", port_name);
        goto HELL;
    }

    close(fd);
    printf("  Success on port %s\n", port_name);
    print_bar();

    return 0;

HELL:
 
    print_bar();
    return -1;
}