virtual_console.rs 61 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050
  1. use core::sync::atomic::{AtomicBool, AtomicIsize, Ordering};
  2. use alloc::{
  3. sync::{Arc, Weak},
  4. vec::Vec,
  5. };
  6. use bitmap::{traits::BitMapOps, StaticBitmap};
  7. use log::warn;
  8. use crate::{
  9. driver::{
  10. serial::serial8250::send_to_default_serial8250_port,
  11. tty::{
  12. console::ConsoleSwitch,
  13. tty_port::{DefaultTtyPort, TtyPort},
  14. ConsoleFont, KDMode,
  15. },
  16. },
  17. libs::{font::FontDesc, rwlock::RwLock},
  18. process::Pid,
  19. };
  20. use super::{
  21. console_map::{TranslationMap, TranslationMapType},
  22. Color, DrawRegion, VtMode, VtModeData, COLOR_TABLE, DEFAULT_BLUE, DEFAULT_GREEN, DEFAULT_RED,
  23. };
  24. pub(super) const NPAR: usize = 16;
  25. lazy_static! {
  26. /// 是否已经添加了软光标
  27. pub(super) static ref SOFTCURSOR_ORIGINAL: RwLock<Option<VcCursor>> = RwLock::new(None);
  28. }
  29. pub static CURRENT_VCNUM: AtomicIsize = AtomicIsize::new(-1);
  30. pub static CONSOLE_BLANKED: AtomicBool = AtomicBool::new(false);
  31. /// ## 虚拟控制台的信息
  32. #[derive(Debug, Clone)]
  33. pub struct VirtualConsoleData {
  34. pub num: usize,
  35. pub state: VirtualConsoleInfo,
  36. pub saved_state: VirtualConsoleInfo,
  37. /// 最大列数
  38. pub cols: usize,
  39. /// 最大行数
  40. pub rows: usize,
  41. // /// 每行的字节数
  42. // pub bytes_per_row: usize,
  43. /// 扫描行数
  44. pub scan_lines: usize,
  45. /// 字符单元高度
  46. pub cell_height: u32,
  47. // /// 实际屏幕地址的开始
  48. // pub screen_base: VirtAddr,
  49. // /// 实际屏幕的结束
  50. // pub scr_end: u64,
  51. /// 可见窗口的开始
  52. pub visible_origin: usize,
  53. /// 滚动窗口的顶部
  54. pub top: usize,
  55. /// 滚动窗口的底部
  56. pub bottom: usize,
  57. /// 当前读取位置
  58. pub pos: usize,
  59. /// 颜色集合
  60. pub palette: [Color; 16],
  61. /// 默认颜色
  62. pub def_color: u8,
  63. /// 下划线颜色
  64. pub underline_color: u32,
  65. /// 斜体颜色
  66. pub italic_color: u32,
  67. /// 半强度颜色
  68. pub half_color: u32,
  69. pub mode: KDMode,
  70. pub vt_mode: VtModeData,
  71. /// 是否启用颜色
  72. pub color_mode: bool,
  73. // 字符
  74. pub hi_font_mask: u16,
  75. pub font: ConsoleFont,
  76. pub erase_char: u16,
  77. pub complement_mask: u16,
  78. pub s_complement_mask: u16,
  79. pub cursor_blink_ms: u16,
  80. pub pid: Option<Pid>,
  81. pub index: usize,
  82. pub vc_state: VirtualConsoleState,
  83. // 一些标志
  84. /// 指示是否显示 ASCII 字符小于 32 的控制字符(vc_disp_ctrl)
  85. pub display_ctrl: bool,
  86. /// 指示是否切换高位(meta)位。Meta 键是一个特殊的按键,用于扩展字符集。
  87. pub toggle_meta: bool,
  88. /// 表示屏幕模式(vc_decscnm)
  89. pub screen_mode: bool,
  90. /// 指定光标移动的起始位置,是相对于屏幕的左上角还是相对于当前页的左上角(vc_decom)
  91. pub origin_mode: bool,
  92. /// 控制光标到达行末时是否自动换行(vc_decawm)
  93. pub autowrap: bool,
  94. /// 控制光标的可见性(vc_deccm)
  95. pub cursor_visible: bool,
  96. /// 光标相关
  97. pub cursor_type: VcCursor,
  98. /// 控制插入或替换模式(vc_decim)
  99. pub insert_mode: bool,
  100. /// 表示一些私有模式或状态,通常由特定终端实现定义(vc_priv)
  101. pub private: Vt102_OP,
  102. /// 是否需要进行自动换行
  103. pub need_wrap: bool,
  104. /// 控制鼠标事件的报告方式
  105. pub report_mouse: u8,
  106. /// 指示终端是否使用 UTF-8 编码
  107. pub utf: bool,
  108. /// UTF-8 编码的字符计数,表示还需要多少个字节才能够构建完成
  109. pub utf_count: u8,
  110. /// UTF-8 编码的字符,表示正在构建的utf字符
  111. pub utf_char: u32,
  112. /// 构建utf时需要的参数,表示目前接收了多少个字节的数据来构建utf字符
  113. pub npar: u32,
  114. ///
  115. pub par: [u32; NPAR],
  116. /// 字符转换表 用于将输入字符映射到特定的字符
  117. pub translate: TranslationMap,
  118. pub tab_stop: StaticBitmap<256>,
  119. pub attr: u8,
  120. /// vc缓冲区
  121. pub screen_buf: Vec<u16>,
  122. /// 对应的Console Driver funcs
  123. driver_funcs: Option<Weak<dyn ConsoleSwitch>>,
  124. /// 对应端口
  125. port: Arc<dyn TtyPort>,
  126. }
  127. impl VirtualConsoleData {
  128. #[inline(never)]
  129. pub fn new(num: usize) -> Self {
  130. Self {
  131. state: VirtualConsoleInfo::new(0, 0),
  132. saved_state: Default::default(),
  133. cols: Default::default(),
  134. rows: Default::default(),
  135. // bytes_per_row: Default::default(),
  136. scan_lines: Default::default(),
  137. cell_height: Default::default(),
  138. // origin: Default::default(),
  139. // scr_end: Default::default(),
  140. visible_origin: Default::default(),
  141. top: Default::default(),
  142. bottom: Default::default(),
  143. palette: [Default::default(); 16],
  144. def_color: Default::default(),
  145. underline_color: Default::default(),
  146. italic_color: Default::default(),
  147. half_color: Default::default(),
  148. mode: Default::default(),
  149. color_mode: Default::default(),
  150. hi_font_mask: Default::default(),
  151. erase_char: Default::default(),
  152. complement_mask: Default::default(),
  153. s_complement_mask: Default::default(),
  154. cursor_blink_ms: 200,
  155. pos: Default::default(),
  156. vt_mode: VtModeData {
  157. mode: VtMode::Auto,
  158. relsig: 0,
  159. acqsig: 0,
  160. },
  161. pid: None,
  162. index: 0,
  163. font: Default::default(),
  164. vc_state: VirtualConsoleState::ESnormal,
  165. display_ctrl: Default::default(),
  166. toggle_meta: Default::default(),
  167. screen_mode: Default::default(),
  168. origin_mode: Default::default(),
  169. autowrap: Default::default(),
  170. cursor_visible: Default::default(),
  171. insert_mode: Default::default(),
  172. private: Vt102_OP::Pecma,
  173. need_wrap: Default::default(),
  174. report_mouse: Default::default(),
  175. utf: Default::default(),
  176. utf_count: Default::default(),
  177. utf_char: Default::default(),
  178. translate: TranslationMap::new(TranslationMapType::Lat1),
  179. npar: Default::default(),
  180. tab_stop: StaticBitmap::new(),
  181. par: [0; 16],
  182. attr: Default::default(),
  183. screen_buf: Default::default(),
  184. driver_funcs: None,
  185. cursor_type: VcCursor::empty(),
  186. num,
  187. port: Arc::new(DefaultTtyPort::new()),
  188. }
  189. }
  190. #[inline]
  191. pub fn port(&self) -> Arc<dyn TtyPort> {
  192. self.port.clone()
  193. }
  194. pub(super) fn init(&mut self, rows: Option<usize>, cols: Option<usize>, clear: bool) {
  195. if let Some(rows) = rows {
  196. self.rows = rows;
  197. }
  198. if let Some(cols) = cols {
  199. self.cols = cols;
  200. }
  201. self.pos = self.cols * self.state.y + self.state.x;
  202. // self.bytes_per_row = self.cols << 1;
  203. self.def_color = 15; // white
  204. self.italic_color = 2; // green
  205. self.underline_color = 3; // cyan
  206. self.half_color = 0x08; // grey
  207. self.screen_buf.resize(self.cols * self.rows, 0);
  208. self.reset(clear);
  209. }
  210. pub fn should_update(&self) -> bool {
  211. self.is_visible() && !CONSOLE_BLANKED.load(Ordering::SeqCst)
  212. }
  213. pub fn is_visible(&self) -> bool {
  214. let cur_vc = CURRENT_VCNUM.load(Ordering::SeqCst);
  215. if cur_vc == -1 {
  216. return false;
  217. }
  218. cur_vc as usize == self.num
  219. }
  220. fn driver_funcs(&self) -> Arc<dyn ConsoleSwitch> {
  221. self.driver_funcs.as_ref().unwrap().upgrade().unwrap()
  222. }
  223. pub(super) fn set_driver_funcs(&mut self, func: Weak<dyn ConsoleSwitch>) {
  224. self.driver_funcs = Some(func);
  225. }
  226. pub(super) fn reset(&mut self, do_clear: bool) {
  227. self.mode = KDMode::KdText;
  228. // unicode?
  229. self.vt_mode.mode = VtMode::Auto;
  230. self.vt_mode.acqsig = 0;
  231. self.vt_mode.relsig = 0;
  232. self.display_ctrl = false;
  233. self.toggle_meta = false;
  234. self.screen_mode = false;
  235. self.origin_mode = false;
  236. self.autowrap = true;
  237. self.cursor_visible = true;
  238. self.insert_mode = false;
  239. self.need_wrap = false;
  240. self.report_mouse = 0;
  241. self.utf_count = 0;
  242. self.translate = TranslationMap::new(TranslationMapType::Lat1);
  243. self.utf = true;
  244. self.pid = None;
  245. self.vc_state = VirtualConsoleState::ESnormal;
  246. self.reset_palette();
  247. // self.cursor_type = VcCursor::CUR_UNDERLINE;
  248. self.cursor_type = VcCursor::CUR_BLOCK;
  249. self.default_attr();
  250. self.update_attr();
  251. self.tab_stop.set_all(false);
  252. for i in (0..256).step_by(8) {
  253. self.tab_stop.set(i, true);
  254. }
  255. self.state.x = 0;
  256. self.state.y = 0;
  257. self.pos = 0;
  258. if do_clear {
  259. self.csi_J(2);
  260. }
  261. }
  262. fn reset_palette(&mut self) {
  263. for (idx, color) in self.palette.iter_mut().enumerate() {
  264. color.red = DEFAULT_RED[idx];
  265. color.green = DEFAULT_GREEN[idx];
  266. color.blue = DEFAULT_BLUE[idx];
  267. }
  268. self.set_palette();
  269. }
  270. fn set_palette(&self) {
  271. if self.mode != KDMode::KdGraphics {
  272. // todo: 通知driver层的Console
  273. let _ = self.driver_funcs().con_set_palette(self, COLOR_TABLE);
  274. }
  275. }
  276. /// ## 翻译字符,将字符转换为终端控制符
  277. /// ### 参数
  278. ///
  279. /// ### c: 需要转换的字符
  280. ///
  281. /// ### 返回值
  282. /// ### (转换后的字符:i32,是否需要更多的数据才能进行转换:bool)
  283. pub(super) fn translate(&mut self, c: &mut u32) -> (Option<u32>, bool) {
  284. if self.vc_state != VirtualConsoleState::ESnormal {
  285. // 在控制字符状态下不需要翻译
  286. return (Some(*c), false);
  287. }
  288. if self.utf && !self.display_ctrl {
  289. // utf模式并且不显示控制字符
  290. let (ret, rescan) = self.translate_unicode(*c);
  291. if let Some(ret) = ret {
  292. *c = ret;
  293. }
  294. return (ret, rescan);
  295. }
  296. return (Some(self.translate_ascii(*c)), false);
  297. }
  298. /// 该数组包含每个字节序列长度变化的阈值
  299. /// 即如果由两个字节组成的unicode字符,则长度应该在UTF8_LENGTH_CHANGES[0] ~ UTF8_LENGTH_CHANGES[1]之间
  300. const UTF8_LENGTH_CHANGES: &'static [u32] = &[
  301. 0x0000007f, 0x000007ff, 0x0000ffff, 0x001fffff, 0x03ffffff, 0x7fffffff,
  302. ];
  303. /// ## 翻译字符,将UTF-8 编码的字符转换为 Unicode 编码
  304. /// ### 参数
  305. ///
  306. /// ### c: 需要转换的字符
  307. ///
  308. /// ### 返回值
  309. /// ### (转换后的字符:i32,是否需要重新传入该字符:bool)
  310. ///
  311. /// !!! 注意,该函数返回true时,元组的第一个数据是无效数据(未转换完成)
  312. fn translate_unicode(&mut self, c: u32) -> (Option<u32>, bool) {
  313. // 收到的字符不是首个
  314. if (c & 0xc0) == 0x80 {
  315. // 已经不需要继续的字符了,说明这个字符是非法的
  316. if self.utf_count == 0 {
  317. return (Some(0xfffd), false);
  318. }
  319. self.utf_char = (self.utf_char << 6) | (c & 0x3f);
  320. self.npar += 1;
  321. self.utf_count -= 1;
  322. if self.utf_count > 0 {
  323. // 表示需要更多字节
  324. return (None, false);
  325. }
  326. let c = self.utf_char;
  327. // 先检查一遍是否合格
  328. if c <= Self::UTF8_LENGTH_CHANGES[self.npar as usize - 1]
  329. || c > Self::UTF8_LENGTH_CHANGES[self.npar as usize]
  330. {
  331. return (Some(0xfffd), false);
  332. }
  333. return (Some(Self::sanitize_unicode(c)), false);
  334. }
  335. // 接收到单个ASCII字符或者一个序列的首字符,且上次的未处理完,则上一个字符视为无效,则需要重新传入该字符处理
  336. if self.utf_count > 0 {
  337. self.utf_count = 0;
  338. return (Some(0xfffd), true);
  339. }
  340. // ascii
  341. if c <= 0x7f {
  342. return (Some(c), false);
  343. }
  344. // 第一个字节
  345. self.npar = 0;
  346. if (c & 0xe0) == 0xc0 {
  347. self.utf_count = 1;
  348. self.utf_char = c & 0x1f;
  349. } else if (c & 0xf0) == 0xe0 {
  350. self.utf_count = 2;
  351. self.utf_char = c & 0x0f;
  352. } else if (c & 0xf8) == 0xf0 {
  353. self.utf_count = 3;
  354. self.utf_char = c & 0x07;
  355. } else if (c & 0xfc) == 0xf8 {
  356. self.utf_count = 4;
  357. self.utf_char = c & 0x03;
  358. } else if (c & 0xfe) == 0xfc {
  359. self.utf_count = 5;
  360. self.utf_char = c & 0x01;
  361. } else {
  362. /* 254 and 255 are invalid */
  363. return (Some(0xfffd), false);
  364. }
  365. (None, false)
  366. }
  367. /// ## 翻译字符,将字符转换为Ascii
  368. fn translate_ascii(&self, c: u32) -> u32 {
  369. let mut c = c;
  370. if self.toggle_meta {
  371. c |= 0x80;
  372. }
  373. return self.translate.translate(c) as u32;
  374. }
  375. /// ## 用于替换无效的 Unicode 代码点(code points)。
  376. /// Unicode 代码点的范围是从 U+0000 到 U+10FFFF,
  377. /// 但是有一些特殊的代码点是无效的或者保留给特定用途的。
  378. /// 这个函数的主要目的是将无效的 Unicode 代码点替换为 U+FFFD,即 Unicode 替代字符。
  379. fn sanitize_unicode(c: u32) -> u32 {
  380. if (0xd800..=0xdfff).contains(&c) || c == 0xfffe || c == 0xffff {
  381. return 0xfffd;
  382. }
  383. return c;
  384. }
  385. /// 用于表示小于 32 的字符中,哪些字符对应的位被设置为 1,
  386. /// 表示这些字符会触发一些特殊的动作,比如光标移动等。
  387. /// 这些字符在 disp_ctrl 模式未开启时不应该被显示为图形符号
  388. const CTRL_ACTION: u32 = 0x0d00ff81;
  389. /// 用于表示哪些控制字符是始终显示的,即便 disp_ctrl 模式未开启。
  390. /// 这些字符对于终端来说是必要的,显示它们是为了保证终端正常工作。
  391. /// 这些字符在 disp_ctrl 模式开启或关闭时都应该显示为控制字符。
  392. const CTRL_ALWAYS: u32 = 0x0800f501;
  393. /// ## 用于判断tc(终端字符)在当前VC下是不是需要显示的控制字符
  394. pub(super) fn is_control(&self, tc: u32, c: u32) -> bool {
  395. // 当前vc状态机不在正常状态,即在接收特殊字符的状态,则是控制字符
  396. if self.vc_state != VirtualConsoleState::ESnormal {
  397. return true;
  398. }
  399. if tc == 0 {
  400. return true;
  401. }
  402. if c < 32 {
  403. if self.display_ctrl {
  404. // 查看在位图中是否有该字符
  405. return Self::CTRL_ALWAYS & (1 << c) != 0;
  406. } else {
  407. return self.utf || (Self::CTRL_ACTION & (1 << c) != 0);
  408. }
  409. }
  410. if c == 127 && !self.display_ctrl {
  411. return true;
  412. }
  413. if c == 128 + 27 {
  414. return true;
  415. }
  416. false
  417. }
  418. pub(super) fn set_cursor(&mut self) {
  419. if self.mode == KDMode::KdGraphics {
  420. return;
  421. }
  422. if self.cursor_visible {
  423. // TODO: 处理选择
  424. self.add_softcursor();
  425. if self.cursor_type.cursor_size() != VcCursor::CUR_NONE {
  426. self.driver_funcs().con_cursor(self, CursorOperation::Draw);
  427. }
  428. } else {
  429. self.hide_cursor();
  430. }
  431. }
  432. /// ## 添加软光标
  433. fn add_softcursor(&mut self) {
  434. let mut i = self.screen_buf[self.pos] as u32;
  435. let cursor_type = self.cursor_type;
  436. if !cursor_type.contains(VcCursor::CUR_SW) {
  437. return;
  438. }
  439. if SOFTCURSOR_ORIGINAL.read_irqsave().is_some() {
  440. // 已经设置了软光标
  441. return;
  442. }
  443. let mut soft_cursor_guard = SOFTCURSOR_ORIGINAL.write_irqsave();
  444. *soft_cursor_guard = Some(unsafe { VcCursor::from_bits_unchecked(i) });
  445. let soft_cursor = soft_cursor_guard.unwrap();
  446. i |= cursor_type.cursor_set();
  447. i ^= cursor_type.cursor_change();
  448. if cursor_type.contains(VcCursor::CUR_ALWAYS_BG)
  449. && ((soft_cursor.bits & VcCursor::CUR_BG.bits) == (i & VcCursor::CUR_BG.bits))
  450. {
  451. i ^= VcCursor::CUR_BG.bits;
  452. }
  453. if cursor_type.contains(VcCursor::CUR_INVERT_FG_BG)
  454. && ((i & VcCursor::CUR_FG.bits) == ((i & VcCursor::CUR_BG.bits) >> 4))
  455. {
  456. i ^= VcCursor::CUR_FG.bits;
  457. }
  458. self.screen_buf[self.pos] = i as u16;
  459. let _ =
  460. self.driver_funcs()
  461. .con_putc(self, i as u16, self.state.y as u32, self.state.x as u32);
  462. }
  463. pub fn hide_cursor(&mut self) {
  464. // TODO: 处理选择
  465. self.driver_funcs().con_cursor(self, CursorOperation::Erase);
  466. self.hide_softcursor();
  467. }
  468. fn hide_softcursor(&mut self) {
  469. let softcursor = SOFTCURSOR_ORIGINAL.upgradeable_read_irqsave();
  470. if softcursor.is_some() {
  471. self.screen_buf[self.pos] = softcursor.unwrap().bits as u16;
  472. let _ = self.driver_funcs().con_putc(
  473. self,
  474. softcursor.unwrap().bits as u16,
  475. self.state.y as u32,
  476. self.state.x as u32,
  477. );
  478. *softcursor.upgrade() = None;
  479. }
  480. }
  481. fn gotoxay(&mut self, x: i32, y: i32) {
  482. if self.origin_mode {
  483. self.gotoxy(x, self.top as i32 + y);
  484. } else {
  485. self.gotoxy(x, y)
  486. }
  487. }
  488. // ## 将当前vc的光标移动到目标位置
  489. fn gotoxy(&mut self, x: i32, y: i32) {
  490. if x < 0 {
  491. self.state.x = 0;
  492. } else if x as usize >= self.cols {
  493. self.state.x = self.cols - 1;
  494. } else {
  495. self.state.x = x as usize;
  496. }
  497. let max_y;
  498. let min_y;
  499. if self.origin_mode {
  500. min_y = self.top;
  501. max_y = self.bottom - 1;
  502. } else {
  503. min_y = 0;
  504. max_y = self.rows - 1;
  505. }
  506. if y < min_y as i32 {
  507. self.state.y = min_y;
  508. } else if y >= max_y as i32 {
  509. self.state.y = max_y;
  510. } else {
  511. self.state.y = y as usize;
  512. }
  513. self.pos = self.state.y * self.cols + self.state.x;
  514. self.need_wrap = false;
  515. }
  516. fn scroll(&mut self, dir: ScrollDir, mut nr: usize) {
  517. // todo: uniscr_srceen
  518. if self.top + nr >= self.bottom {
  519. // 滚动超过一页,则按一页计算
  520. nr = self.bottom - self.top - 1;
  521. }
  522. if nr < 1 {
  523. return;
  524. }
  525. if self.is_visible()
  526. && self
  527. .driver_funcs()
  528. .con_scroll(self, self.top, self.bottom, dir, nr)
  529. {
  530. // 如果成功
  531. return;
  532. }
  533. // 调整screen_buf
  534. let count = nr * self.cols;
  535. if dir == ScrollDir::Up {
  536. for i in self.screen_buf[0..count].iter_mut() {
  537. *i = self.erase_char;
  538. }
  539. self.screen_buf.rotate_left(count);
  540. } else if dir == ScrollDir::Down {
  541. todo!();
  542. }
  543. }
  544. /// ## 退格
  545. fn backspace(&mut self) {
  546. if self.state.x > 0 {
  547. self.pos -= 1;
  548. self.state.x -= 1;
  549. self.need_wrap = false;
  550. // TODO: notify
  551. }
  552. }
  553. /// ## 换行
  554. fn line_feed(&mut self) {
  555. if self.state.y + 1 == self.bottom {
  556. self.scroll(ScrollDir::Up, 1);
  557. } else if self.state.y < self.rows - 1 {
  558. self.state.y += 1;
  559. self.pos += self.cols;
  560. }
  561. self.need_wrap = false;
  562. // TODO: Notify write
  563. }
  564. /// ## 回车
  565. fn carriage_return(&mut self) {
  566. // 写入位置回退到该行最前
  567. self.pos -= self.state.x;
  568. self.need_wrap = false;
  569. self.state.x = 0;
  570. }
  571. /// ## Del
  572. fn delete(&mut self) {
  573. // ignore
  574. }
  575. /// ## 向上滚动虚拟终端的内容,或者将光标上移一行
  576. fn reverse_index(&mut self) {
  577. if self.state.y == self.top {
  578. self.scroll(ScrollDir::Down, 1);
  579. } else if self.state.y > 0 {
  580. self.state.y -= 1;
  581. self.pos -= self.cols;
  582. }
  583. self.need_wrap = false;
  584. }
  585. /// https://code.dragonos.org.cn/xref/linux-6.1.9/drivers/tty/vt/vt.c#restore_cur
  586. fn restore_cursor(&mut self) {
  587. self.saved_state = self.state.clone();
  588. self.gotoxy(self.state.x as i32, self.state.y as i32);
  589. // TODO Gx_charset
  590. self.update_attr();
  591. self.need_wrap = false;
  592. todo!()
  593. }
  594. /// ## 设置当前vt的各项属性
  595. fn set_mode(&mut self, on_off: bool) {
  596. for i in 0..self.npar as usize {
  597. if self.private == Vt102_OP::Pdec {
  598. match self.par[i] {
  599. 1 => {
  600. todo!("kbd todo");
  601. }
  602. 3 => {
  603. todo!("reisze todo");
  604. }
  605. 5 => {
  606. todo!("invert_screen todo");
  607. }
  608. 6 => {
  609. self.origin_mode = on_off;
  610. if on_off {
  611. self.gotoxy(0, self.top as i32);
  612. } else {
  613. self.gotoxy(0, 0);
  614. }
  615. }
  616. 7 => {
  617. self.autowrap = on_off;
  618. }
  619. 8 => {
  620. todo!("kbd todo");
  621. }
  622. 9 => {
  623. todo!("report mouse todo");
  624. }
  625. 25 => {
  626. self.cursor_visible = on_off;
  627. }
  628. 1000 => {
  629. todo!("report mouse todo");
  630. }
  631. _ => {}
  632. }
  633. } else {
  634. match self.par[i] {
  635. 3 => {
  636. self.display_ctrl = on_off;
  637. }
  638. 4 => {
  639. self.insert_mode = on_off;
  640. }
  641. 20 => {
  642. todo!("kbd todo");
  643. }
  644. _ => {}
  645. }
  646. }
  647. }
  648. }
  649. #[inline(never)]
  650. fn do_getpars(&mut self, c: char) {
  651. if c == ';' && self.npar < (NPAR - 1) as u32 {
  652. self.npar += 1;
  653. return;
  654. }
  655. if c.is_ascii_digit() {
  656. self.par[self.npar as usize] *= 10;
  657. self.par[self.npar as usize] += (c as u8 - b'0') as u32;
  658. return;
  659. }
  660. if c as u8 >= 0x20 && c as u8 <= 0x3f {
  661. self.vc_state = VirtualConsoleState::EScsiignore;
  662. return;
  663. }
  664. self.vc_state = VirtualConsoleState::ESnormal;
  665. match c {
  666. 'h' => {
  667. if self.private <= Vt102_OP::Pdec {
  668. self.set_mode(true);
  669. }
  670. return;
  671. }
  672. 'l' => {
  673. if self.private <= Vt102_OP::Pdec {
  674. self.set_mode(false);
  675. }
  676. return;
  677. }
  678. 'c' => {
  679. if self.private == Vt102_OP::Pdec {
  680. if self.par[0] != 0 {
  681. self.cursor_type =
  682. VcCursor::make_cursor(self.par[0], self.par[1], self.par[2])
  683. } else {
  684. self.cursor_type = VcCursor::CUR_UNDERLINE;
  685. }
  686. return;
  687. }
  688. }
  689. 'm' => {
  690. if self.private == Vt102_OP::Pdec {
  691. if self.par[0] != 0 {
  692. self.complement_mask = (self.par[0] << 8 | self.par[1]) as u16;
  693. } else {
  694. self.complement_mask = self.s_complement_mask;
  695. }
  696. return;
  697. }
  698. }
  699. 'n' => {
  700. if self.private == Vt102_OP::Pecma {
  701. if self.par[0] == 5 {
  702. send_to_default_serial8250_port("tty status report todo".as_bytes());
  703. panic!();
  704. } else if self.par[0] == 6 {
  705. send_to_default_serial8250_port("tty cursor report todo".as_bytes());
  706. panic!();
  707. }
  708. }
  709. return;
  710. }
  711. _ => {}
  712. }
  713. if self.private != Vt102_OP::Pecma {
  714. self.private = Vt102_OP::Pecma;
  715. return;
  716. }
  717. match c {
  718. 'G' | '`' => {
  719. if self.par[0] != 0 {
  720. self.par[0] -= 1;
  721. }
  722. self.gotoxy(self.par[0] as i32, self.state.y as i32);
  723. return;
  724. }
  725. 'A' => {
  726. if self.par[0] == 0 {
  727. self.par[0] += 1;
  728. }
  729. self.gotoxy(
  730. self.state.x as i32,
  731. (self.state.y - self.par[0] as usize) as i32,
  732. );
  733. return;
  734. }
  735. 'B' | 'e' => {
  736. if self.par[0] == 0 {
  737. self.par[0] += 1;
  738. }
  739. self.gotoxy(
  740. self.state.x as i32,
  741. (self.state.y + self.par[0] as usize) as i32,
  742. );
  743. return;
  744. }
  745. 'C' | 'a' => {
  746. if self.par[0] == 0 {
  747. self.par[0] += 1;
  748. }
  749. self.gotoxy(
  750. (self.state.x + self.par[0] as usize) as i32,
  751. self.state.y as i32,
  752. );
  753. return;
  754. }
  755. 'D' => {
  756. if self.par[0] == 0 {
  757. self.par[0] += 1;
  758. }
  759. self.gotoxy(
  760. self.state.x as i32 - self.par[0] as i32,
  761. self.state.y as i32,
  762. );
  763. return;
  764. }
  765. 'E' => {
  766. if self.par[0] == 0 {
  767. self.par[0] += 1;
  768. }
  769. self.gotoxy(0, (self.state.y + self.par[0] as usize) as i32);
  770. return;
  771. }
  772. 'F' => {
  773. if self.par[0] == 0 {
  774. self.par[0] += 1;
  775. }
  776. self.gotoxy(0, self.state.y as i32 - self.par[0] as i32);
  777. return;
  778. }
  779. 'd' => {
  780. if self.par[0] != 0 {
  781. self.par[0] -= 1;
  782. }
  783. self.gotoxay(self.state.x as i32, self.par[0] as i32);
  784. return;
  785. }
  786. 'H' | 'f' => {
  787. // MOVETO
  788. if self.par[0] != 0 {
  789. self.par[0] -= 1;
  790. }
  791. if self.par[1] != 0 {
  792. self.par[1] -= 1;
  793. }
  794. self.gotoxay(self.par[1] as i32, self.par[0] as i32);
  795. return;
  796. }
  797. 'J' => {
  798. self.csi_J(self.par[0]);
  799. return;
  800. }
  801. 'K' => {
  802. self.csi_K(self.par[0]);
  803. return;
  804. }
  805. 'L' => {
  806. todo!("csi_L todo");
  807. }
  808. 'M' => {
  809. todo!("csi_M todo");
  810. }
  811. 'P' => {
  812. todo!("csi_P todo");
  813. }
  814. // 非ANSI标准,为ANSI拓展
  815. 'S' => {
  816. self.scroll(ScrollDir::Up, self.par[0] as usize);
  817. return;
  818. }
  819. 'T' => {
  820. self.scroll(ScrollDir::Down, self.par[0] as usize);
  821. return;
  822. }
  823. 'c' => {
  824. if self.par[0] == 0 {
  825. warn!("respone ID todo");
  826. }
  827. return;
  828. }
  829. 'g' => {
  830. if self.par[0] == 0 && self.state.x < 256 {
  831. self.tab_stop.set(self.state.x, true);
  832. } else if self.par[0] == 3 {
  833. self.tab_stop.set_all(false);
  834. }
  835. return;
  836. }
  837. 'm' => {
  838. self.csi_m();
  839. return;
  840. }
  841. 'q' => {
  842. if self.par[0] < 4 {
  843. todo!("vt set led state todo");
  844. }
  845. return;
  846. }
  847. 'r' => {
  848. if self.par[0] == 0 {
  849. self.par[0] += 1;
  850. }
  851. if self.par[1] == 0 {
  852. self.par[1] = self.rows as u32;
  853. }
  854. if self.par[0] < self.par[1] && self.par[1] <= self.rows as u32 {
  855. self.top = self.par[0] as usize - 1;
  856. self.bottom = self.par[1] as usize;
  857. self.gotoxay(0, 0);
  858. }
  859. return;
  860. }
  861. 's' => {
  862. self.saved_state = self.state.clone();
  863. return;
  864. }
  865. 'u' => {
  866. self.restore_cursor();
  867. return;
  868. }
  869. '@' => {
  870. todo!("csi_at todo");
  871. }
  872. ']' => {
  873. todo!("set termial command todo");
  874. }
  875. _ => {}
  876. }
  877. }
  878. /// ## 处理Control Sequence Introducer(控制序列引导符) m字符
  879. #[inline(never)]
  880. fn csi_m(&mut self) {
  881. let mut i = 0;
  882. loop {
  883. if i > self.npar as usize {
  884. break;
  885. }
  886. match self.par[i] {
  887. 0 => {
  888. // 关闭所有属性
  889. self.default_attr();
  890. }
  891. 1 => {
  892. // 设置粗体
  893. self.state.intensity = VirtualConsoleIntensity::Bold;
  894. }
  895. 2 => {
  896. // 设置半亮度(半明显
  897. self.state.intensity = VirtualConsoleIntensity::HalfBright;
  898. }
  899. 3 => {
  900. // 斜体
  901. self.state.italic = true;
  902. }
  903. 4 | 21 => {
  904. // 下划线
  905. // 21是设置双下划线,但是不支持,就单下划线
  906. self.state.underline = true;
  907. }
  908. 5 => {
  909. // 设置闪烁
  910. self.state.blink = true;
  911. }
  912. 7 => {
  913. // 设置反显(前景色与背景色对调)
  914. self.state.reverse = true;
  915. }
  916. 10 => {
  917. // 选择主要字体
  918. todo!()
  919. }
  920. 11 => {
  921. // 选择第一个替代字体
  922. todo!()
  923. }
  924. 12 => {
  925. // 选择第二个替代字体
  926. todo!()
  927. }
  928. 22 => {
  929. // 关闭粗体和半亮度,恢复正常亮度
  930. self.state.intensity = VirtualConsoleIntensity::Normal;
  931. }
  932. 23 => {
  933. // 关闭斜体
  934. self.state.italic = false;
  935. }
  936. 24 => {
  937. // 关闭下划线
  938. self.state.underline = false;
  939. }
  940. 25 => {
  941. // 关闭字符闪烁
  942. self.state.blink = false;
  943. }
  944. 27 => {
  945. // 关闭反显
  946. self.state.reverse = false;
  947. }
  948. 38 => {
  949. // 设置前景色
  950. let (idx, color) = self.t416_color(i);
  951. i = idx;
  952. if let Some(color) = color {
  953. let mut max = color.red.max(color.green);
  954. max = max.max(color.blue);
  955. let mut hue = 0;
  956. if color.red > max / 2 {
  957. hue |= 4;
  958. }
  959. if color.green > max / 2 {
  960. hue |= 2;
  961. }
  962. if color.blue > max / 2 {
  963. hue |= 1;
  964. }
  965. if hue == 7 && max <= 0x55 {
  966. hue = 0;
  967. self.state.intensity = VirtualConsoleIntensity::Bold;
  968. } else if max > 0xaa {
  969. self.state.intensity = VirtualConsoleIntensity::Bold;
  970. } else {
  971. self.state.intensity = VirtualConsoleIntensity::Normal;
  972. }
  973. self.state.color = (self.state.color & 0xf0) | hue;
  974. }
  975. }
  976. 48 => {
  977. // 设置背景色
  978. let (idx, color) = self.t416_color(i);
  979. i = idx;
  980. if let Some(color) = color {
  981. self.state.color = (self.state.color & 0x0f)
  982. | ((color.red as u8 & 0x80) >> 1)
  983. | ((color.green as u8 & 0x80) >> 2)
  984. | ((color.blue as u8 & 0x80) >> 3);
  985. }
  986. }
  987. 39 => {
  988. // 恢复默认前景色
  989. self.state.color = (self.def_color & 0x0f) | (self.state.color & 0xf0);
  990. }
  991. 49 => {
  992. // 恢复默认背景色
  993. self.state.color = (self.def_color & 0xf0) | (self.state.color & 0x0f);
  994. }
  995. _ => {
  996. if self.par[i] >= 90 && self.par[i] <= 107 {
  997. if self.par[i] < 100 {
  998. self.state.intensity = VirtualConsoleIntensity::Bold;
  999. }
  1000. self.par[i] -= 60;
  1001. }
  1002. if self.par[i] >= 30 && self.par[i] <= 37 {
  1003. self.state.color =
  1004. COLOR_TABLE[self.par[i] as usize - 30] | self.state.color & 0xf0;
  1005. } else if self.par[i] >= 40 && self.par[i] <= 47 {
  1006. self.state.color =
  1007. (COLOR_TABLE[self.par[i] as usize - 40] << 4) | self.state.color & 0xf0;
  1008. }
  1009. }
  1010. }
  1011. i += 1;
  1012. }
  1013. self.update_attr();
  1014. }
  1015. /// ## 处理Control Sequence Introducer(控制序列引导符) J字符
  1016. /// 该命令用于擦除终端显示区域的部分或全部内容。根据参数 vpar 的不同值,执行不同的擦除操作:
  1017. /// - vpar 为 0 时,擦除从光标位置到显示区域末尾的内容;
  1018. /// - vpar 为 1 时,擦除从显示区域起始位置到光标位置的内容;
  1019. /// - vpar 为 2 或 3 时,分别表示擦除整个显示区域的内容,其中参数 3 还会清除回滚缓冲区的内容。
  1020. #[allow(non_snake_case)]
  1021. fn csi_J(&mut self, vpar: u32) {
  1022. let count;
  1023. let start;
  1024. match vpar {
  1025. 0 => {
  1026. // 擦除从光标位置到显示区域末尾的内容
  1027. count = self.screen_buf.len() - self.pos;
  1028. start = self.pos;
  1029. }
  1030. 1 => {
  1031. // 擦除从显示区域起始位置到光标位置的内容
  1032. count = self.pos;
  1033. start = 0;
  1034. }
  1035. 2 => {
  1036. // 擦除整个显示区域的内容
  1037. count = self.screen_buf.len();
  1038. start = 0;
  1039. }
  1040. 3 => {
  1041. // 表示擦除整个显示区域的内容,还会清除回滚缓冲区的内容
  1042. // TODO:当前未实现回滚缓冲
  1043. count = self.screen_buf.len();
  1044. start = 0;
  1045. }
  1046. _ => {
  1047. return;
  1048. }
  1049. }
  1050. for i in self.screen_buf[start..(start + count)].iter_mut() {
  1051. *i = self.erase_char;
  1052. }
  1053. if self.should_update() {
  1054. self.do_update_region(start, count)
  1055. }
  1056. self.need_wrap = false;
  1057. }
  1058. /// ## 处理Control Sequence Introducer(控制序列引导符) K字符
  1059. /// 该命令用于擦除终端当前行的部分或全部内容。根据参数 vpar 的不同值,执行不同的擦除操作:
  1060. /// - vpar 为 0 时,擦除从光标位置到该行末尾的内容
  1061. /// - vpar 为 1 时,擦除从该行起始位置到光标位置的内容
  1062. /// - vpar 为 2 时,擦除整个行。
  1063. #[allow(non_snake_case)]
  1064. fn csi_K(&mut self, vpar: u32) {
  1065. let count;
  1066. let start;
  1067. match vpar {
  1068. 0 => {
  1069. // 擦除从光标位置到该行末尾的内容
  1070. count = self.cols - self.state.x;
  1071. start = self.pos;
  1072. }
  1073. 1 => {
  1074. // 擦除从该行起始位置到光标位置的内容
  1075. count = self.state.x + 1;
  1076. start = self.pos - self.state.x;
  1077. }
  1078. 2 => {
  1079. // 擦除整个行
  1080. count = self.cols;
  1081. start = self.pos - self.state.x;
  1082. }
  1083. _ => {
  1084. return;
  1085. }
  1086. }
  1087. let max_idx = self.screen_buf.len();
  1088. for i in self.screen_buf[start..max_idx.min(start + count)].iter_mut() {
  1089. *i = self.erase_char;
  1090. }
  1091. if self.should_update() {
  1092. self.do_update_region(start, count.min(max_idx - start))
  1093. }
  1094. self.need_wrap = false;
  1095. }
  1096. fn t416_color(&mut self, mut idx: usize) -> (usize, Option<Color>) {
  1097. idx += 1;
  1098. if idx > self.npar as usize {
  1099. return (idx, None);
  1100. }
  1101. if self.par[idx] == 5 && idx < self.npar as usize {
  1102. // 256色
  1103. idx += 1;
  1104. return (idx, Some(Color::from_256(self.par[idx])));
  1105. } else if self.par[idx] == 2 && idx + 3 <= self.npar as usize {
  1106. // 24位
  1107. let color = Color {
  1108. red: self.par[idx + 1] as u16,
  1109. green: self.par[idx + 2] as u16,
  1110. blue: self.par[idx + 3] as u16,
  1111. ..Default::default()
  1112. };
  1113. idx += 3;
  1114. return (idx, Some(color));
  1115. } else {
  1116. return (idx, None);
  1117. }
  1118. }
  1119. /// ## 处理终端控制字符
  1120. #[inline(never)]
  1121. pub(super) fn do_control(&mut self, ch: u32) {
  1122. // 首先检查是否处于 ANSI 控制字符串状态
  1123. if self.vc_state.is_ansi_control_string() && (8..=13).contains(&ch) {
  1124. return;
  1125. }
  1126. match ch {
  1127. 0 => {
  1128. return;
  1129. }
  1130. 7 => {
  1131. // BEL
  1132. if self.vc_state.is_ansi_control_string() {
  1133. self.vc_state = VirtualConsoleState::ESnormal;
  1134. }
  1135. // TODO: 发出声音?
  1136. return;
  1137. }
  1138. 8 => {
  1139. // BS backspace
  1140. self.backspace();
  1141. return;
  1142. }
  1143. 9 => {
  1144. // 水平制表符(Horizontal Tab)
  1145. self.pos -= self.state.x;
  1146. let ret = self.tab_stop.next_index(self.state.x + 1);
  1147. if let Some(x) = ret {
  1148. self.state.x = x;
  1149. } else {
  1150. self.state.x = self.cols - 1;
  1151. }
  1152. self.pos += self.state.x;
  1153. // TODO: notify
  1154. return;
  1155. }
  1156. 10..=12 => {
  1157. // LD line feed
  1158. self.line_feed();
  1159. // TODO: 检查键盘模式
  1160. self.carriage_return();
  1161. return;
  1162. }
  1163. 13 => {
  1164. // CR 回车符
  1165. self.carriage_return();
  1166. return;
  1167. }
  1168. 14 => {
  1169. todo!("Gx_charset todo!");
  1170. }
  1171. 15 => {
  1172. todo!("Gx_charset todo!");
  1173. }
  1174. 24 | 26 => {
  1175. self.vc_state = VirtualConsoleState::ESnormal;
  1176. return;
  1177. }
  1178. 27 => {
  1179. // esc
  1180. self.vc_state = VirtualConsoleState::ESesc;
  1181. return;
  1182. }
  1183. 127 => {
  1184. // delete
  1185. self.delete();
  1186. return;
  1187. }
  1188. 155 => {
  1189. // '['
  1190. self.vc_state = VirtualConsoleState::ESsquare;
  1191. return;
  1192. }
  1193. _ => {}
  1194. }
  1195. match self.vc_state {
  1196. VirtualConsoleState::ESesc => {
  1197. self.vc_state = VirtualConsoleState::ESnormal;
  1198. match ch as u8 as char {
  1199. '[' => {
  1200. self.vc_state = VirtualConsoleState::ESsquare;
  1201. }
  1202. ']' => {
  1203. self.vc_state = VirtualConsoleState::ESnonstd;
  1204. }
  1205. '_' => {
  1206. self.vc_state = VirtualConsoleState::ESapc;
  1207. }
  1208. '^' => {
  1209. self.vc_state = VirtualConsoleState::ESpm;
  1210. }
  1211. '%' => {
  1212. self.vc_state = VirtualConsoleState::ESpercent;
  1213. }
  1214. 'E' => {
  1215. self.carriage_return();
  1216. self.line_feed();
  1217. }
  1218. 'M' => {
  1219. self.reverse_index();
  1220. }
  1221. 'D' => {
  1222. self.line_feed();
  1223. }
  1224. 'H' => {
  1225. if self.state.x < 256 {
  1226. self.tab_stop.set(self.state.x, true);
  1227. }
  1228. }
  1229. 'P' => {
  1230. self.vc_state = VirtualConsoleState::ESdcs;
  1231. }
  1232. 'Z' => {
  1233. todo!("Respond ID todo!");
  1234. }
  1235. '7' => self.saved_state = self.state.clone(),
  1236. '8' => self.restore_cursor(),
  1237. '(' => {
  1238. self.vc_state = VirtualConsoleState::ESsetG0;
  1239. }
  1240. ')' => {
  1241. self.vc_state = VirtualConsoleState::ESsetG1;
  1242. }
  1243. '#' => {
  1244. self.vc_state = VirtualConsoleState::EShash;
  1245. }
  1246. 'c' => {
  1247. self.reset(true);
  1248. }
  1249. '>' => {
  1250. todo!("clr_kbd todo");
  1251. }
  1252. '=' => {
  1253. todo!("set_kbd todo");
  1254. }
  1255. _ => {}
  1256. }
  1257. }
  1258. VirtualConsoleState::ESsquare => {
  1259. for i in self.par.iter_mut() {
  1260. *i = 0;
  1261. }
  1262. self.vc_state = VirtualConsoleState::ESgetpars;
  1263. self.npar = 0;
  1264. let c = ch as u8 as char;
  1265. if c == '[' {
  1266. self.vc_state = VirtualConsoleState::ESfunckey;
  1267. return;
  1268. }
  1269. match c {
  1270. '?' => {
  1271. self.private = Vt102_OP::Pdec;
  1272. return;
  1273. }
  1274. '>' => {
  1275. self.private = Vt102_OP::Pgt;
  1276. return;
  1277. }
  1278. '=' => {
  1279. self.private = Vt102_OP::Peq;
  1280. return;
  1281. }
  1282. '<' => {
  1283. self.private = Vt102_OP::Plt;
  1284. return;
  1285. }
  1286. _ => {}
  1287. }
  1288. self.private = Vt102_OP::Pecma;
  1289. self.do_getpars(c);
  1290. }
  1291. VirtualConsoleState::ESgetpars => {
  1292. let c = ch as u8 as char;
  1293. self.do_getpars(c);
  1294. }
  1295. VirtualConsoleState::ESfunckey => {
  1296. self.vc_state = VirtualConsoleState::ESnormal;
  1297. return;
  1298. }
  1299. VirtualConsoleState::EShash => {
  1300. self.vc_state = VirtualConsoleState::ESnormal;
  1301. if ch as u8 as char == '8' {
  1302. self.erase_char = (self.erase_char & 0xff00) | 'E' as u16;
  1303. self.csi_J(2);
  1304. self.erase_char = (self.erase_char & 0xff00) | ' ' as u16;
  1305. self.do_update_region(0, self.screen_buf.len());
  1306. }
  1307. return;
  1308. }
  1309. VirtualConsoleState::ESsetG0 => {
  1310. todo!("SetGx todo");
  1311. }
  1312. VirtualConsoleState::ESsetG1 => {
  1313. todo!("SetGx todo");
  1314. }
  1315. VirtualConsoleState::ESpercent => {
  1316. self.vc_state = VirtualConsoleState::ESnormal;
  1317. let c = ch as u8 as char;
  1318. match c {
  1319. '@' => {
  1320. self.utf = false;
  1321. return;
  1322. }
  1323. 'G' | '8' => {
  1324. self.utf = true;
  1325. return;
  1326. }
  1327. _ => {}
  1328. }
  1329. return;
  1330. }
  1331. VirtualConsoleState::EScsiignore => {
  1332. if (20..=0x3f).contains(&ch) {
  1333. return;
  1334. }
  1335. self.vc_state = VirtualConsoleState::ESnormal;
  1336. return;
  1337. }
  1338. VirtualConsoleState::ESnonstd => {
  1339. let c = ch as u8 as char;
  1340. if c == 'P' {
  1341. for i in self.par.iter_mut() {
  1342. *i = 0;
  1343. }
  1344. self.npar = 0;
  1345. self.vc_state = VirtualConsoleState::ESpalette;
  1346. return;
  1347. } else if c == 'R' {
  1348. self.reset_palette();
  1349. self.vc_state = VirtualConsoleState::ESnormal;
  1350. } else if c.is_ascii_digit() {
  1351. self.vc_state = VirtualConsoleState::ESosc;
  1352. } else {
  1353. self.vc_state = VirtualConsoleState::ESnormal;
  1354. }
  1355. }
  1356. VirtualConsoleState::ESpalette => {
  1357. let c = ch as u8 as char;
  1358. if c.is_ascii_hexdigit() {
  1359. self.npar += 1;
  1360. self.par[self.npar as usize] = c.to_digit(16).unwrap();
  1361. if self.npar == 7 {
  1362. let mut i = self.par[0] as usize;
  1363. let mut j = 0;
  1364. self.palette[i].red = self.par[j] as u16;
  1365. j += 1;
  1366. self.palette[i].green = self.par[j] as u16;
  1367. j += 1;
  1368. self.palette[i].blue = self.par[j] as u16;
  1369. j += 1;
  1370. i += 1;
  1371. self.palette[i].red = self.par[j] as u16;
  1372. j += 1;
  1373. self.palette[i].green = self.par[j] as u16;
  1374. j += 1;
  1375. self.palette[i].blue = self.par[j] as u16;
  1376. self.set_palette();
  1377. self.vc_state = VirtualConsoleState::ESnormal;
  1378. }
  1379. }
  1380. }
  1381. VirtualConsoleState::ESosc => {}
  1382. VirtualConsoleState::ESapc => {}
  1383. VirtualConsoleState::ESpm => {}
  1384. VirtualConsoleState::ESdcs => {}
  1385. VirtualConsoleState::ESnormal => {}
  1386. }
  1387. }
  1388. #[inline(never)]
  1389. pub(super) fn console_write_normal(
  1390. &mut self,
  1391. mut tc: u32,
  1392. c: u32,
  1393. draw: &mut DrawRegion,
  1394. ) -> bool {
  1395. let mut attr = self.attr;
  1396. let himask = self.hi_font_mask;
  1397. let charmask = if himask == 0 { 0xff } else { 0x1ff };
  1398. let mut width = 1;
  1399. // 表示需不需要反转
  1400. let mut invert = false;
  1401. if self.utf && !self.display_ctrl && FontDesc::is_double_width(c) {
  1402. width = 2;
  1403. }
  1404. let tmp = self.unicode_to_index(tc);
  1405. if tmp & (!charmask as i32) != 0 {
  1406. if tmp == -1 || tmp == -2 {
  1407. return false;
  1408. }
  1409. // 未找到
  1410. if (!self.utf || self.display_ctrl || c < 128) && c & !charmask == 0 {
  1411. tc = c;
  1412. } else {
  1413. let tmp = self.unicode_to_index(0xfffd);
  1414. if tmp < 0 {
  1415. invert = true;
  1416. let tmp = self.unicode_to_index('?' as u32);
  1417. if tmp < 0 {
  1418. tc = '?' as u32;
  1419. } else {
  1420. tc = tmp as u32;
  1421. }
  1422. attr = self.invert_attr();
  1423. self.flush(draw);
  1424. }
  1425. }
  1426. }
  1427. loop {
  1428. if self.need_wrap || self.insert_mode {
  1429. self.flush(draw);
  1430. }
  1431. if self.need_wrap {
  1432. self.carriage_return();
  1433. self.line_feed();
  1434. }
  1435. if self.insert_mode {
  1436. self.insert_char(1);
  1437. }
  1438. // TODO: 处理unicode screen buf
  1439. if himask != 0 {
  1440. tc = (if tc & 0x100 != 0 { himask as u32 } else { 0 }) | (tc & 0xff);
  1441. }
  1442. tc |= ((attr as u32) << 8) & (!himask as u32);
  1443. // warn!(
  1444. // "ch {} pos {} x {} y {} cols {}",
  1445. // c as u8 as char,
  1446. // self.pos,
  1447. // self.state.x,
  1448. // self.state.y,
  1449. // self.cols,
  1450. // );
  1451. self.screen_buf[self.pos] = tc as u16;
  1452. if draw.x.is_none() {
  1453. // 设置draw参数
  1454. draw.x = Some(self.state.x as u32);
  1455. draw.offset = self.pos;
  1456. }
  1457. if self.state.x == self.cols - 1 {
  1458. // 需要换行?
  1459. self.need_wrap = self.autowrap;
  1460. draw.size += 1;
  1461. } else {
  1462. self.state.x += 1;
  1463. self.pos += 1;
  1464. draw.size += 1;
  1465. }
  1466. width -= 1;
  1467. if width == 0 {
  1468. break;
  1469. }
  1470. let tmp = self.unicode_to_index(' ' as u32);
  1471. tc = if tmp < 0 { ' ' as u32 } else { tmp as u32 };
  1472. }
  1473. if invert {
  1474. self.flush(draw);
  1475. }
  1476. true
  1477. }
  1478. /// ## 当前vc插入nr个字符
  1479. fn insert_char(&mut self, nr: usize) {
  1480. // TODO: 管理unicode屏幕信息
  1481. let pos = self.pos;
  1482. // 把当前位置以后得字符向后移动nr*2位
  1483. self.screen_buf[pos..].rotate_right(nr * 2);
  1484. // 把空出来的位置用erase_char填充
  1485. for c in &mut self.screen_buf[pos..(pos + nr * 2)] {
  1486. *c = self.erase_char
  1487. }
  1488. self.need_wrap = false;
  1489. // 更新本行后面部分
  1490. self.do_update_region(self.pos, self.cols - self.state.x);
  1491. }
  1492. /// ## 更新虚拟控制台指定区域的显示
  1493. fn do_update_region(&self, mut start: usize, mut count: usize) {
  1494. let ret = self.driver_funcs().con_getxy(self, start);
  1495. let (mut x, mut y) = if let Ok((_, tmp_x, tmp_y)) = ret {
  1496. // start = tmp_start;
  1497. (tmp_x, tmp_y)
  1498. } else {
  1499. (start % self.cols, start / self.cols)
  1500. };
  1501. loop {
  1502. // 记录当前字符的属性
  1503. let mut attr = self.screen_buf[start] & 0xff00;
  1504. let mut startx = x;
  1505. let mut size = 0;
  1506. while count != 0 && x < self.cols {
  1507. // 检查属性是否变化,如果属性变了,则将前一个字符先输出
  1508. if attr != (self.screen_buf[start] & 0xff00) && size > 0 {
  1509. let _ = self.driver_funcs().con_putcs(
  1510. self,
  1511. &self.screen_buf[start..],
  1512. size,
  1513. y as u32,
  1514. startx as u32,
  1515. );
  1516. startx = x;
  1517. start += size;
  1518. size = 0;
  1519. attr = self.screen_buf[start] & 0xff00;
  1520. }
  1521. size += 1;
  1522. x += 1;
  1523. count -= 1;
  1524. }
  1525. if size > 0 {
  1526. let _ = self.driver_funcs().con_putcs(
  1527. self,
  1528. &self.screen_buf[start..],
  1529. size,
  1530. y as u32,
  1531. startx as u32,
  1532. );
  1533. }
  1534. if count == 0 {
  1535. break;
  1536. }
  1537. // 一行
  1538. x = 0;
  1539. y += 1;
  1540. let ret = self.driver_funcs().con_getxy(self, start);
  1541. if let Ok(ret) = ret {
  1542. start = ret.0;
  1543. } else {
  1544. return;
  1545. }
  1546. }
  1547. }
  1548. const UNI_DIRECT_MAKS: u32 = 0x01ff;
  1549. const UNI_DIRECT_BASE: u32 = 0xf000;
  1550. /// ## unicode字符转对应的坐标,暂时这样写,还没有适配unicode
  1551. /// 这里是糊代码的,后面重写
  1552. fn unicode_to_index(&self, ch: u32) -> i32 {
  1553. if ch > 0xfff {
  1554. // 未找到
  1555. return -4;
  1556. } else if ch < 0x20 {
  1557. // 不可打印
  1558. return -1;
  1559. } else if ch == 0xfeff || (0x200b..=0x200f).contains(&ch) {
  1560. // 零长空格
  1561. return -2;
  1562. } else if (ch & !Self::UNI_DIRECT_MAKS) == Self::UNI_DIRECT_BASE {
  1563. return (ch & Self::UNI_DIRECT_MAKS) as i32;
  1564. }
  1565. // TODO: 暂时这样写,表示不支持
  1566. return -3;
  1567. }
  1568. fn invert_attr(&self) -> u8 {
  1569. if !self.color_mode {
  1570. return self.attr ^ 0x08;
  1571. }
  1572. if self.hi_font_mask == 0x100 {
  1573. return (self.attr & 0x11) | ((self.attr & 0xe0) >> 4) | ((self.attr & 0x0e) << 4);
  1574. }
  1575. return (self.attr & 0x88) | ((self.attr & 0x70) >> 4) | ((self.attr & 0x07) << 4);
  1576. }
  1577. pub(super) fn flush(&self, draw: &mut DrawRegion) {
  1578. if draw.x.is_none() {
  1579. return;
  1580. }
  1581. let _ = self.driver_funcs().con_putcs(
  1582. self,
  1583. &self.screen_buf[draw.offset..draw.offset + draw.size],
  1584. draw.size,
  1585. self.state.y as u32,
  1586. draw.x.unwrap(),
  1587. );
  1588. draw.x = None;
  1589. draw.size = 0;
  1590. }
  1591. fn build_attr(
  1592. &self,
  1593. color: u8,
  1594. intensity: VirtualConsoleIntensity,
  1595. blink: bool,
  1596. underline: bool,
  1597. reverse: bool,
  1598. italic: bool,
  1599. ) -> u8 {
  1600. let ret = self
  1601. .driver_funcs()
  1602. .con_build_attr(self, color, intensity, blink, underline, reverse, italic);
  1603. if let Ok(ret) = ret {
  1604. return ret;
  1605. }
  1606. let mut ret = color;
  1607. if !self.color_mode {
  1608. return intensity as u8
  1609. | (italic as u8) << 1
  1610. | (underline as u8) << 2
  1611. | (reverse as u8) << 3
  1612. | (blink as u8) << 7;
  1613. }
  1614. if italic {
  1615. ret = (ret & 0xf0) | self.italic_color as u8;
  1616. } else if underline {
  1617. ret = (ret & 0xf0) | self.underline_color as u8;
  1618. } else if intensity == VirtualConsoleIntensity::HalfBright {
  1619. ret = (ret & 0xf0) | self.half_color as u8;
  1620. }
  1621. if reverse {
  1622. ret = (ret & 0x88) | (((ret >> 4) | (ret << 4)) & 0x77);
  1623. }
  1624. if blink {
  1625. ret ^= 0x80;
  1626. }
  1627. if intensity == VirtualConsoleIntensity::Bold {
  1628. ret ^= 0x08;
  1629. }
  1630. if self.hi_font_mask == 0x100 {
  1631. ret <<= 1;
  1632. }
  1633. ret
  1634. }
  1635. pub(super) fn update_attr(&mut self) {
  1636. self.attr = self.build_attr(
  1637. self.state.color,
  1638. self.state.intensity,
  1639. self.state.blink,
  1640. self.state.underline,
  1641. self.state.reverse ^ self.screen_mode,
  1642. self.state.italic,
  1643. );
  1644. self.erase_char = ' ' as u16
  1645. | ((self.build_attr(
  1646. self.state.color,
  1647. VirtualConsoleIntensity::Normal,
  1648. self.state.blink,
  1649. false,
  1650. self.screen_mode,
  1651. false,
  1652. ) as u16)
  1653. << 8);
  1654. }
  1655. fn default_attr(&mut self) {
  1656. self.state.intensity = VirtualConsoleIntensity::Normal;
  1657. self.state.italic = false;
  1658. self.state.underline = false;
  1659. self.state.reverse = false;
  1660. self.state.blink = false;
  1661. self.state.color = self.def_color;
  1662. }
  1663. }
  1664. /// ## 虚拟控制台的状态信息
  1665. #[derive(Debug, Default, Clone)]
  1666. pub struct VirtualConsoleInfo {
  1667. // x,y表示光标坐标
  1668. pub x: usize,
  1669. pub y: usize,
  1670. pub color: u8,
  1671. /// 表示字符的强度
  1672. intensity: VirtualConsoleIntensity,
  1673. /// 斜体
  1674. italic: bool,
  1675. /// 下划线
  1676. underline: bool,
  1677. /// 字符闪烁
  1678. blink: bool,
  1679. /// 前景与背景色反转
  1680. reverse: bool,
  1681. }
  1682. impl VirtualConsoleInfo {
  1683. pub fn new(x: usize, y: usize) -> Self {
  1684. Self {
  1685. x,
  1686. y,
  1687. color: Default::default(),
  1688. intensity: Default::default(),
  1689. italic: Default::default(),
  1690. underline: Default::default(),
  1691. blink: Default::default(),
  1692. reverse: Default::default(),
  1693. }
  1694. }
  1695. }
  1696. /// 字符强度
  1697. #[derive(Debug, Clone, PartialEq, Copy)]
  1698. pub enum VirtualConsoleIntensity {
  1699. /// 暗淡
  1700. HalfBright = 0,
  1701. /// 正常
  1702. Normal = 1,
  1703. /// 粗体
  1704. Bold = 2,
  1705. }
  1706. impl Default for VirtualConsoleIntensity {
  1707. fn default() -> Self {
  1708. Self::Normal
  1709. }
  1710. }
  1711. /// ## 虚拟控制台的状态
  1712. ///
  1713. /// 可以把VC的接收字符理解为一个状态机
  1714. #[derive(Debug, PartialEq, Clone)]
  1715. pub enum VirtualConsoleState {
  1716. /// 正常状态
  1717. ESnormal,
  1718. /// 收到了转义字符 \e,即"Escape"字符
  1719. ESesc,
  1720. /// 收到了 "[" 字符,通常是 ANSI 控制序列的开始
  1721. ESsquare,
  1722. /// 解析参数状态
  1723. ESgetpars,
  1724. /// 功能键状态
  1725. ESfunckey,
  1726. /// 收到了 "#" 字符
  1727. EShash,
  1728. /// 设置 G0 字符集状态
  1729. ESsetG0,
  1730. /// 设置 G1 字符集状态
  1731. ESsetG1,
  1732. /// 收到了 "%" 字符
  1733. ESpercent,
  1734. /// 忽略 ANSI 控制序列状态
  1735. EScsiignore,
  1736. /// 非标准字符状态
  1737. ESnonstd,
  1738. /// 调色板状态
  1739. ESpalette,
  1740. /// Operating System Command (OSC) 状态
  1741. ESosc,
  1742. /// Application Program Command (APC) 状态
  1743. ESapc,
  1744. /// Privacy Message (PM) 状态
  1745. ESpm,
  1746. /// Device Control String (DCS) 状态
  1747. ESdcs,
  1748. }
  1749. impl VirtualConsoleState {
  1750. pub fn is_ansi_control_string(&self) -> bool {
  1751. if *self == Self::ESosc
  1752. || *self == Self::ESapc
  1753. || *self == Self::ESpm
  1754. || *self == Self::ESdcs
  1755. {
  1756. return true;
  1757. }
  1758. false
  1759. }
  1760. }
  1761. #[derive(Debug, Clone, PartialEq, PartialOrd)]
  1762. #[allow(non_camel_case_types)]
  1763. pub enum Vt102_OP {
  1764. Pecma,
  1765. Pdec,
  1766. Peq,
  1767. Pgt,
  1768. Plt,
  1769. }
  1770. bitflags! {
  1771. #[derive(Default)]
  1772. pub struct VcCursor: u32 {
  1773. /// 默认
  1774. const CUR_DEF = 0;
  1775. /// 无光标
  1776. const CUR_NONE = 1;
  1777. /// 下划线形式
  1778. const CUR_UNDERLINE = 2;
  1779. /// 光标占据底部的三分之一
  1780. const CUR_LOWER_THIRD = 3;
  1781. /// 光标占据底部的一半
  1782. const CUR_LOWER_HALF = 4;
  1783. /// 光标占据底部的三分之二
  1784. const CUR_TWO_THIRDS = 5;
  1785. /// 光标为块状(方块)形式
  1786. const CUR_BLOCK = 6;
  1787. /// 光标属性,用于指示软件光标
  1788. const CUR_SW = 0x000010;
  1789. /// 光标属性,用于指示光标是否始终在背景上显示
  1790. const CUR_ALWAYS_BG = 0x000020;
  1791. /// 光标属性,用于指示前景和背景是否反转
  1792. const CUR_INVERT_FG_BG = 0x000040;
  1793. /// 光标前景色属性,用于指定光标的前景色
  1794. const CUR_FG = 0x000700;
  1795. /// 光标背景色属性,用于指定光标的背景色
  1796. const CUR_BG = 0x007000;
  1797. }
  1798. }
  1799. impl VcCursor {
  1800. pub fn make_cursor(size: u32, change: u32, set: u32) -> Self {
  1801. unsafe { Self::from_bits_unchecked(size | (change << 8) | (set << 16)) }
  1802. }
  1803. pub fn cursor_size(&self) -> Self {
  1804. Self::from_bits_truncate(self.bits & 0x00000f)
  1805. }
  1806. pub fn cursor_set(&self) -> u32 {
  1807. (self.bits & 0xff0000) >> 8
  1808. }
  1809. pub fn cursor_change(&self) -> u32 {
  1810. self.bits & 0x00ff00
  1811. }
  1812. }
  1813. #[derive(Debug, PartialEq)]
  1814. #[allow(dead_code)]
  1815. pub enum CursorOperation {
  1816. Draw,
  1817. Erase,
  1818. Move,
  1819. }
  1820. #[derive(Debug, PartialEq, Clone, Copy)]
  1821. pub enum ScrollDir {
  1822. Up,
  1823. Down,
  1824. }