Jeremy Soller
117 lines
2.8 KiB
Rust
117 lines
2.8 KiB
Rust
use core::{mem, slice};
|
|
use syscall;
|
|
|
|
use header::errno;
|
|
use header::termios;
|
|
use platform;
|
|
use platform::e;
|
|
use platform::types::*;
|
|
|
|
use super::winsize;
|
|
|
|
pub const TCGETS: c_ulong = 0x5401;
|
|
pub const TCSETS: c_ulong = 0x5402;
|
|
|
|
pub const TCFLSH: c_ulong = 0x540B;
|
|
|
|
pub const TIOCGPGRP: c_ulong = 0x540F;
|
|
pub const TIOCSPGRP: c_ulong = 0x5410;
|
|
|
|
pub const TIOCGWINSZ: c_ulong = 0x5413;
|
|
pub const TIOCSWINSZ: c_ulong = 0x5414;
|
|
|
|
fn dup_read<T>(fd: c_int, name: &str, t: &mut T) -> syscall::Result<usize> {
|
|
let dup = syscall::dup(fd as usize, name.as_bytes())?;
|
|
|
|
let size = mem::size_of::<T>();
|
|
|
|
let res = syscall::read(dup, unsafe {
|
|
slice::from_raw_parts_mut(t as *mut T as *mut u8, size)
|
|
});
|
|
|
|
let _ = syscall::close(dup);
|
|
|
|
res.map(|bytes| bytes / size)
|
|
}
|
|
|
|
fn dup_write<T>(fd: c_int, name: &str, t: &T) -> syscall::Result<usize> {
|
|
let dup = syscall::dup(fd as usize, name.as_bytes())?;
|
|
|
|
let size = mem::size_of::<T>();
|
|
|
|
let res = syscall::write(dup, unsafe {
|
|
slice::from_raw_parts(t as *const T as *const u8, size)
|
|
});
|
|
|
|
let _ = syscall::close(dup);
|
|
|
|
res.map(|bytes| bytes / size)
|
|
}
|
|
|
|
#[no_mangle]
|
|
pub unsafe extern "C" fn ioctl(fd: c_int, request: c_ulong, out: *mut c_void) -> c_int {
|
|
match request {
|
|
TCGETS => {
|
|
let termios = &mut *(out as *mut termios::termios);
|
|
if e(dup_read(fd, "termios", termios)) == !0 {
|
|
-1
|
|
} else {
|
|
0
|
|
}
|
|
}
|
|
|
|
TCSETS => {
|
|
let termios = &*(out as *const termios::termios);
|
|
if e(dup_write(fd, "termios", termios)) == !0 {
|
|
-1
|
|
} else {
|
|
0
|
|
}
|
|
}
|
|
TCFLSH => {
|
|
let queue = out as c_int;
|
|
if e(dup_write(fd, "flush", &queue)) == !0 {
|
|
-1
|
|
} else {
|
|
0
|
|
}
|
|
}
|
|
TIOCGPGRP => {
|
|
let pgrp = &mut *(out as *mut pid_t);
|
|
if e(dup_read(fd, "pgrp", pgrp)) == !0 {
|
|
-1
|
|
} else {
|
|
0
|
|
}
|
|
}
|
|
TIOCSPGRP => {
|
|
let pgrp = &*(out as *const pid_t);
|
|
if e(dup_write(fd, "pgrp", pgrp)) == !0 {
|
|
-1
|
|
} else {
|
|
0
|
|
}
|
|
}
|
|
TIOCGWINSZ => {
|
|
let winsize = &mut *(out as *mut winsize);
|
|
if e(dup_read(fd, "winsize", winsize)) == !0 {
|
|
-1
|
|
} else {
|
|
0
|
|
}
|
|
}
|
|
TIOCSWINSZ => {
|
|
let winsize = &*(out as *const winsize);
|
|
if e(dup_write(fd, "winsize", winsize)) == !0 {
|
|
-1
|
|
} else {
|
|
0
|
|
}
|
|
}
|
|
_ => {
|
|
platform::errno = errno::EINVAL;
|
|
-1
|
|
}
|
|
}
|
|
}
|