libc: Implement openpty function
Signed-off-by: Xiang Xiao <xiaoxiang@xiaomi.com> Change-Id: I36e02af0145cd6e740766e7484cc9d5ce410e5e4
This commit is contained in:
Xiang Xiao
Brennan Ashton
parent
4befbdfa4b
commit
e1ff0c4f08
63
include/pty.h
Normal file
63
include/pty.h
Normal file
@ -0,0 +1,63 @@
|
||||
/****************************************************************************
|
||||
* include/pty.h
|
||||
*
|
||||
* Licensed to the Apache Software Foundation (ASF) under one or more
|
||||
* contributor license agreements. See the NOTICE file distributed with
|
||||
* this work for additional information regarding copyright ownership. The
|
||||
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
||||
* "License"); you may not use this file except in compliance with the
|
||||
* License. You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
||||
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
||||
* License for the specific language governing permissions and limitations
|
||||
* under the License.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
#ifndef __INCLUDE_PTY_H
|
||||
#define __INCLUDE_PTY_H
|
||||
|
||||
/****************************************************************************
|
||||
* Included Files
|
||||
****************************************************************************/
|
||||
|
||||
#include <nuttx/config.h>
|
||||
#include <nuttx/compiler.h>
|
||||
|
||||
#include <termios.h>
|
||||
#include <sys/ioctl.h>
|
||||
|
||||
#if defined(CONFIG_SERIAL_TERMIOS) && defined(CONFIG_PSEUDOTERM)
|
||||
|
||||
/****************************************************************************
|
||||
* Public Function Prototypes
|
||||
****************************************************************************/
|
||||
|
||||
#undef EXTERN
|
||||
#if defined(__cplusplus)
|
||||
#define EXTERN extern "C"
|
||||
extern "C"
|
||||
{
|
||||
#else
|
||||
#define EXTERN extern
|
||||
#endif
|
||||
|
||||
/****************************************************************************
|
||||
* Create pseudo tty pair with name and set terminal attributes according
|
||||
* to term and win and return handles for both ends in master and slave.
|
||||
****************************************************************************/
|
||||
|
||||
int openpty(FAR int *master, FAR int *slave, FAR char *name,
|
||||
FAR const struct termios *term, FAR const struct winsize *win);
|
||||
|
||||
#undef EXTERN
|
||||
#if defined(__cplusplus)
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* CONFIG_SERIAL_TERMIOS && CONFIG_PSEUDOTERM */
|
||||
#endif /* __INCLUDE_PTY_H */
|
||||
@ -34,6 +34,9 @@ endif
|
||||
|
||||
ifeq ($(CONFIG_PSEUDOTERM),y)
|
||||
CSRCS += lib_ptsname.c lib_ptsnamer.c lib_unlockpt.c
|
||||
ifeq ($(CONFIG_SERIAL_TERMIOS),y)
|
||||
CSRCS += lib_openpty.c
|
||||
endif
|
||||
endif
|
||||
|
||||
# Add the stdlib directory to the build
|
||||
|
||||
159
libs/libc/stdlib/lib_openpty.c
Normal file
159
libs/libc/stdlib/lib_openpty.c
Normal file
@ -0,0 +1,159 @@
|
||||
/****************************************************************************
|
||||
* libs/libc/stdlib/lib_openpty.c
|
||||
*
|
||||
* Licensed to the Apache Software Foundation (ASF) under one or more
|
||||
* contributor license agreements. See the NOTICE file distributed with
|
||||
* this work for additional information regarding copyright ownership. The
|
||||
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
||||
* "License"); you may not use this file except in compliance with the
|
||||
* License. You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
||||
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
||||
* License for the specific language governing permissions and limitations
|
||||
* under the License.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Included Files
|
||||
****************************************************************************/
|
||||
|
||||
#include <fcntl.h>
|
||||
#include <pty.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#include <nuttx/serial/pty.h>
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
static int openmaster(void)
|
||||
{
|
||||
#ifdef CONFIG_PSEUDOTERM_SUSV1
|
||||
return open("dev/ptmx", O_RDWR);
|
||||
#else
|
||||
int minor;
|
||||
|
||||
for (minor = 0; minor < 256; minor++)
|
||||
{
|
||||
char devname[16];
|
||||
int fd;
|
||||
|
||||
snprintf(devname, 16, "/dev/pty%d", minor);
|
||||
fd = open(devname, O_RDWR);
|
||||
if (fd < 0)
|
||||
{
|
||||
/* Fail, register and try again */
|
||||
|
||||
pty_register(minor);
|
||||
fd = open(devname, O_RDWR);
|
||||
}
|
||||
|
||||
if (fd >= 0)
|
||||
{
|
||||
return fd;
|
||||
}
|
||||
}
|
||||
|
||||
return -1;
|
||||
#endif
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Name: openpty
|
||||
*
|
||||
* Description:
|
||||
* The openpty() function finds an available pseudoterminal and
|
||||
* returns file descriptors in master and slave. If name is not
|
||||
* NULL, the filename of the slave is returned in name. If term
|
||||
* is not NULL, the terminal parameters of the slave will be set
|
||||
* to the values in term. If win is not NULL, the window size of
|
||||
* the slave will be set to the values in win.
|
||||
*
|
||||
* Returned Value:
|
||||
* If a call to openpty() is not successful, -1 is returned and
|
||||
* errno is set to indicate the error. Otherwise, return 0.
|
||||
*
|
||||
****************************************************************************/
|
||||
|
||||
int openpty(FAR int *master, FAR int *slave, FAR char *name,
|
||||
FAR const struct termios *term, FAR const struct winsize *win)
|
||||
{
|
||||
char buf[64];
|
||||
int ret;
|
||||
|
||||
/* Open the pseudo terminal master */
|
||||
|
||||
ret = openmaster();
|
||||
if (ret < 0)
|
||||
{
|
||||
return ret;
|
||||
}
|
||||
|
||||
*master = ret;
|
||||
|
||||
/* Configure the pseudo terminal master */
|
||||
|
||||
ret = grantpt(*master);
|
||||
if (ret < 0)
|
||||
{
|
||||
goto err;
|
||||
}
|
||||
|
||||
ret = unlockpt(*master);
|
||||
if (ret < 0)
|
||||
{
|
||||
goto err;
|
||||
}
|
||||
|
||||
/* Open the pseudo terminal slave */
|
||||
|
||||
ret = ptsname_r(*master, buf, sizeof(buf));
|
||||
if (ret < 0)
|
||||
{
|
||||
goto err;
|
||||
}
|
||||
|
||||
ret = open(buf, O_RDWR | O_NOCTTY);
|
||||
if (ret < 0)
|
||||
{
|
||||
goto err;
|
||||
}
|
||||
|
||||
*slave = ret;
|
||||
|
||||
if (name != NULL)
|
||||
{
|
||||
strcpy(name, buf);
|
||||
}
|
||||
|
||||
/* Configure the pseudo terminal slave */
|
||||
|
||||
if (term != NULL)
|
||||
{
|
||||
tcsetattr(*slave, TCSAFLUSH, term);
|
||||
}
|
||||
|
||||
if (win != NULL)
|
||||
{
|
||||
ioctl(*slave, TIOCSWINSZ, win);
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err:
|
||||
close(*master);
|
||||
return ret;
|
||||
}
|
||||
Loading…
Reference in New Issue
Block a user