linux: ported all ioctl calls to syscalls

This commit is contained in:
Cristian Maglie
2014-12-15 18:08:23 +01:00
parent 25f974f062
commit 259139a5db

View File

@@ -19,19 +19,6 @@ package serial
#include <linux/serial.h> #include <linux/serial.h>
// Define (eventually) missing constants
#ifndef IUCLC
const tcflag_t IUCLC = 0;
#endif
#if defined(PAREXT)
const tcflag_t FIXED_PAR_FLAG = PAREXT;
#elif defined(CMSPAR)
const tcflag_t FIXED_PAR_FLAG = CMSPAR;
#else
const tcflag_t FIXED_PAR_FLAG = 0;
#endif
//int fcntl_wrapper(int fd, int cmd, int arg) { //int fcntl_wrapper(int fd, int cmd, int arg) {
// return fcntl(fd, cmd, arg); // return fcntl(fd, cmd, arg);
//} //}
@@ -78,15 +65,14 @@ func releaseExclusiveAccess(handle int) error {
return err return err
} }
func getTermSettings(handle int) (*C.struct_termios, error) { func getTermSettings(handle int) (*syscall.Termios, error) {
settings := new(C.struct_termios) settings := &syscall.Termios{}
_, err := C.tcgetattr(C.int(handle), settings) err := ioctl(handle, syscall.TCGETS, uintptr(unsafe.Pointer(settings)))
return settings, err return settings, err
} }
func setTermSettings(handle int, settings *C.struct_termios) error { func setTermSettings(handle int, settings *syscall.Termios) error {
_, err := C.tcsetattr(C.int(handle), C.TCSANOW, settings) return ioctl(handle, syscall.TCSETS, uintptr(unsafe.Pointer(settings)))
return err
} }
func getErrno(err error) int { func getErrno(err error) int {
@@ -163,38 +149,37 @@ func (port *linuxSerialPort) Write(p []byte) (n int, err error) {
return syscall.Write(port.Handle, p) return syscall.Write(port.Handle, p)
} }
var baudrateMap = map[int]C.speed_t{ var baudrateMap = map[int]uint32{
0: C.B0, 50: syscall.B50,
50: C.B50, 75: syscall.B75,
75: C.B75, 110: syscall.B110,
110: C.B110, 134: syscall.B134,
134: C.B134, 150: syscall.B150,
150: C.B150, 200: syscall.B200,
200: C.B200, 300: syscall.B300,
300: C.B300, 600: syscall.B600,
600: C.B600, 1200: syscall.B1200,
1200: C.B1200, 1800: syscall.B1800,
1800: C.B1800, 2400: syscall.B2400,
2400: C.B2400, 4800: syscall.B4800,
4800: C.B4800, 9600: syscall.B9600,
9600: C.B9600, 19200: syscall.B19200,
19200: C.B19200, 38400: syscall.B38400,
38400: C.B38400, 57600: syscall.B57600,
57600: C.B57600, 115200: syscall.B115200,
115200: C.B115200, 230400: syscall.B230400,
230400: C.B230400, 460800: syscall.B460800,
460800: C.B460800, 500000: syscall.B500000,
500000: C.B500000, 576000: syscall.B576000,
576000: C.B576000, 921600: syscall.B921600,
921600: C.B921600, 1000000: syscall.B1000000,
1000000: C.B1000000, 1152000: syscall.B1152000,
1152000: C.B1152000, 1500000: syscall.B1500000,
1500000: C.B1500000, 2000000: syscall.B2000000,
2000000: C.B2000000, 2500000: syscall.B2500000,
2500000: C.B2500000, 3000000: syscall.B3000000,
3000000: C.B3000000, 3500000: syscall.B3500000,
3500000: C.B3500000, 4000000: syscall.B4000000,
4000000: C.B4000000,
} }
func (port *linuxSerialPort) SetSpeed(speed int) error { func (port *linuxSerialPort) SetSpeed(speed int) error {
@@ -212,38 +197,40 @@ func (port *linuxSerialPort) SetSpeed(speed int) error {
} }
func (port *linuxSerialPort) SetParity(parity Parity) error { func (port *linuxSerialPort) SetParity(parity Parity) error {
const FIXED_PARITY_FLAG uint32 = 0 // may be CMSPAR or PAREXT
settings, err := getTermSettings(port.Handle) settings, err := getTermSettings(port.Handle)
if err != nil { if err != nil {
return err return err
} }
switch parity { switch parity {
case PARITY_NONE: case PARITY_NONE:
settings.c_cflag &= ^C.tcflag_t(syscall.PARENB | syscall.PARODD | C.FIXED_PAR_FLAG) settings.Cflag &= ^uint32(syscall.PARENB | syscall.PARODD | FIXED_PARITY_FLAG)
settings.c_iflag &= ^C.tcflag_t(syscall.INPCK) settings.Iflag &= ^uint32(syscall.INPCK)
case PARITY_ODD: case PARITY_ODD:
settings.c_cflag |= syscall.PARENB | syscall.PARODD settings.Cflag |= syscall.PARENB | syscall.PARODD
settings.c_cflag &= ^C.tcflag_t(C.FIXED_PAR_FLAG) settings.Cflag &= ^uint32(FIXED_PARITY_FLAG)
settings.c_iflag |= syscall.INPCK settings.Iflag |= syscall.INPCK
case PARITY_EVEN: case PARITY_EVEN:
settings.c_cflag &= ^C.tcflag_t(syscall.PARODD | C.FIXED_PAR_FLAG) settings.Cflag &= ^uint32(syscall.PARODD | FIXED_PARITY_FLAG)
settings.c_cflag |= syscall.PARENB settings.Cflag |= syscall.PARENB
settings.c_iflag |= syscall.INPCK settings.Iflag |= syscall.INPCK
case PARITY_MARK: case PARITY_MARK:
settings.c_cflag |= syscall.PARENB | syscall.PARODD | C.FIXED_PAR_FLAG settings.Cflag |= syscall.PARENB | syscall.PARODD | FIXED_PARITY_FLAG
settings.c_iflag |= syscall.INPCK settings.Iflag |= syscall.INPCK
case PARITY_SPACE: case PARITY_SPACE:
settings.c_cflag &= ^C.tcflag_t(syscall.PARODD) settings.Cflag &= ^uint32(syscall.PARODD)
settings.c_cflag |= syscall.PARENB | C.FIXED_PAR_FLAG settings.Cflag |= syscall.PARENB | FIXED_PARITY_FLAG
settings.c_iflag |= syscall.INPCK settings.Iflag |= syscall.INPCK
} }
return setTermSettings(port.Handle, settings) return setTermSettings(port.Handle, settings)
} }
var databitsMap = map[int]C.tcflag_t{ var databitsMap = map[int]uint32{
5: C.CS5, 5: syscall.CS5,
6: C.CS6, 6: syscall.CS6,
7: C.CS7, 7: syscall.CS7,
8: C.CS8, 8: syscall.CS8,
} }
func (port *linuxSerialPort) SetDataBits(bits int) error { func (port *linuxSerialPort) SetDataBits(bits int) error {
@@ -255,8 +242,8 @@ func (port *linuxSerialPort) SetDataBits(bits int) error {
if err != nil { if err != nil {
return err return err
} }
settings.c_cflag &= ^C.tcflag_t(syscall.CSIZE) settings.Cflag &= ^uint32(syscall.CSIZE)
settings.c_cflag |= databits settings.Cflag |= databits
return setTermSettings(port.Handle, settings) return setTermSettings(port.Handle, settings)
} }
@@ -267,9 +254,9 @@ func (port *linuxSerialPort) SetStopBits(bits StopBits) error {
} }
switch bits { switch bits {
case STOPBITS_ONE: case STOPBITS_ONE:
settings.c_cflag &= ^C.tcflag_t(syscall.CSTOPB) settings.Cflag &= ^uint32(syscall.CSTOPB)
case STOPBITS_ONEPOINTFIVE, STOPBITS_TWO: case STOPBITS_ONEPOINTFIVE, STOPBITS_TWO:
settings.c_cflag |= syscall.CSTOPB settings.Cflag |= syscall.CSTOPB
} }
return setTermSettings(port.Handle, settings) return setTermSettings(port.Handle, settings)
} }
@@ -295,16 +282,16 @@ func OpenPort(portName string, exclusive bool) (SerialPort, error) {
} }
// Set local mode // Set local mode
settings.c_cflag |= C.CREAD | C.CLOCAL settings.Cflag |= C.CREAD | C.CLOCAL
// Set raw mode // Set raw mode
settings.c_lflag &= ^C.tcflag_t(C.ICANON | C.ECHO | C.ECHOE | C.ECHOK | C.ECHONL | C.ECHOCTL | C.ECHOPRT | C.ECHOKE | C.ISIG | C.IEXTEN) settings.Lflag &= ^uint32(syscall.ICANON | syscall.ECHO | syscall.ECHOE | syscall.ECHOK | syscall.ECHONL | syscall.ECHOCTL | syscall.ECHOPRT | syscall.ECHOKE | syscall.ISIG | syscall.IEXTEN)
settings.c_iflag &= ^C.tcflag_t(C.IXON | C.IXOFF | C.IXANY | C.INPCK | C.IGNPAR | C.PARMRK | C.ISTRIP | C.IGNBRK | C.BRKINT | C.INLCR | C.IGNCR | C.ICRNL | C.IUCLC) settings.Iflag &= ^uint32(syscall.IXON | syscall.IXOFF | syscall.IXANY | syscall.INPCK | syscall.IGNPAR | syscall.PARMRK | syscall.ISTRIP | syscall.IGNBRK | syscall.BRKINT | syscall.INLCR | syscall.IGNCR | syscall.ICRNL | syscall.IUCLC)
settings.c_oflag &= ^C.tcflag_t(C.OPOST) settings.Oflag &= ^uint32(syscall.OPOST)
// Block reads until at least one char is available (no timeout) // Block reads until at least one char is available (no timeout)
settings.c_cc[C.VMIN] = 1 settings.Cc[syscall.VMIN] = 1
settings.c_cc[C.VTIME] = 0 settings.Cc[syscall.VTIME] = 0
err = setTermSettings(handle, settings) err = setTermSettings(handle, settings)
if err != nil { if err != nil {