mirror of
https://github.com/dragonpilot/dragonpilot.git
synced 2026-09-30 19:33:42 +08:00
rav4kumar
61 lines
1.3 KiB
Python
61 lines
1.3 KiB
Python
import sys
|
|
import termios
|
|
#import time
|
|
from termios import (BRKINT, CS8, CSIZE, ECHO, ICANON, ICRNL, IEXTEN, INPCK,
|
|
ISIG, ISTRIP, IXON, PARENB, VMIN, VTIME)
|
|
#from typing import Any
|
|
|
|
# Indexes for termios list.
|
|
IFLAG = 0
|
|
OFLAG = 1
|
|
CFLAG = 2
|
|
LFLAG = 3
|
|
ISPEED = 4
|
|
OSPEED = 5
|
|
CC = 6
|
|
|
|
running = True
|
|
|
|
def keyboard_shutdown():
|
|
global running
|
|
running = False
|
|
|
|
def getch():
|
|
fd = sys.stdin.fileno()
|
|
old_settings = termios.tcgetattr(fd)
|
|
try:
|
|
# set
|
|
mode = termios.tcgetattr(fd)
|
|
mode[IFLAG] = mode[IFLAG] & ~(BRKINT | ICRNL | INPCK | ISTRIP | IXON)
|
|
#mode[OFLAG] = mode[OFLAG] & ~(OPOST)
|
|
mode[CFLAG] = mode[CFLAG] & ~(CSIZE | PARENB)
|
|
mode[CFLAG] = mode[CFLAG] | CS8
|
|
mode[LFLAG] = mode[LFLAG] & ~(ECHO | ICANON | IEXTEN | ISIG)
|
|
mode[CC][VMIN] = 1
|
|
mode[CC][VTIME] = 0
|
|
termios.tcsetattr(fd, termios.TCSAFLUSH, mode)
|
|
|
|
ch = sys.stdin.read(1)
|
|
finally:
|
|
termios.tcsetattr(fd, termios.TCSADRAIN, old_settings)
|
|
return ch
|
|
|
|
def keyboard_poll_thread(q):
|
|
global running
|
|
|
|
while running:
|
|
c = getch()
|
|
# print("got %s" % c)
|
|
if c == '1':
|
|
q.put(str("cruise_up"))
|
|
if c == '2':
|
|
q.put(str("cruise_down"))
|
|
if c == '3':
|
|
q.put(str("cruise_cancel"))
|
|
if c == 'q':
|
|
q.put(str("quit"))
|
|
if c == 'c':
|
|
q.put(str("quit"))
|
|
if c == 3:
|
|
q.put(str("quit"))
|