123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513 |
- use alloc::{
- string::{String, ToString},
- sync::{Arc, Weak},
- vec::Vec,
- };
- use log::warn;
- use system_error::SystemError;
- use crate::{
- driver::{
- base::{
- class::Class,
- device::{
- bus::Bus, device_manager, driver::Driver, Device, DeviceCommonData, DeviceType,
- IdTable,
- },
- kobject::{KObjType, KObject, KObjectCommonData, KObjectState, LockedKObjectState},
- kset::KSet,
- },
- tty::virtual_terminal::virtual_console::{CursorOperation, VcCursor, VirtualConsoleData},
- },
- filesystem::{
- kernfs::KernFSInode,
- sysfs::{file::sysfs_emit_str, Attribute, AttributeGroup, SysFSOpsSupport},
- vfs::syscall::ModeType,
- },
- libs::{
- rwlock::{RwLockReadGuard, RwLockWriteGuard},
- spinlock::{SpinLock, SpinLockGuard},
- },
- };
- use super::{fbmem::sys_class_graphics_instance, FbCursor, ScrollMode};
- pub mod framebuffer_console;
- /// framebuffer console设备管理器实例
- static mut FB_CONSOLE_MANAGER: Option<FbConsoleManager> = None;
- pub fn fb_console_manager() -> &'static FbConsoleManager {
- unsafe { FB_CONSOLE_MANAGER.as_ref().unwrap() }
- }
- /// 初始化framebuffer console
- pub(super) fn fb_console_init() -> Result<(), SystemError> {
- // todo: 对全局的console信号量加锁(linux中是console_lock)
- let fbcon_device: Arc<FbConsoleDevice> = FbConsoleDevice::new();
- {
- let fbcon_manager = FbConsoleManager::new(fbcon_device.clone());
- unsafe { FB_CONSOLE_MANAGER = Some(fbcon_manager) };
- }
- device_manager().register(fbcon_device.clone() as Arc<dyn Device>)?;
- fb_console_manager().init_device()?;
- return Ok(());
- }
- /// framebuffer console设备管理器
- #[derive(Debug)]
- pub struct FbConsoleManager {
- _inner: SpinLock<InnerFbConsoleManager>,
- /// framebuffer console设备实例
- /// (对应`/sys/class/graphics/fbcon`)
- device: Arc<FbConsoleDevice>,
- }
- impl FbConsoleManager {
- pub fn new(device: Arc<FbConsoleDevice>) -> Self {
- return Self {
- _inner: SpinLock::new(InnerFbConsoleManager {}),
- device,
- };
- }
- #[allow(dead_code)]
- #[inline(always)]
- pub fn device(&self) -> &Arc<FbConsoleDevice> {
- &self.device
- }
- /// 初始化设备
- fn init_device(&self) -> Result<(), SystemError> {
- return Ok(()); // todo
- }
- }
- #[derive(Debug)]
- struct InnerFbConsoleManager {}
- #[derive(Debug)]
- struct InnerFbConsoleDevice {
- device_common: DeviceCommonData,
- kobject_common: KObjectCommonData,
- }
- /// `/sys/class/graphics/fbcon`代表的 framebuffer console 设备
- #[derive(Debug)]
- #[cast_to([sync] Device)]
- pub struct FbConsoleDevice {
- inner: SpinLock<InnerFbConsoleDevice>,
- kobj_state: LockedKObjectState,
- }
- impl FbConsoleDevice {
- const NAME: &'static str = "fbcon";
- pub fn new() -> Arc<Self> {
- return Arc::new(Self {
- inner: SpinLock::new(InnerFbConsoleDevice {
- device_common: DeviceCommonData::default(),
- kobject_common: KObjectCommonData::default(),
- }),
- kobj_state: LockedKObjectState::new(None),
- });
- }
- fn inner(&self) -> SpinLockGuard<InnerFbConsoleDevice> {
- self.inner.lock()
- }
- }
- impl KObject for FbConsoleDevice {
- fn as_any_ref(&self) -> &dyn core::any::Any {
- self
- }
- fn set_inode(&self, inode: Option<Arc<KernFSInode>>) {
- self.inner().kobject_common.kern_inode = inode;
- }
- fn inode(&self) -> Option<Arc<KernFSInode>> {
- self.inner().kobject_common.kern_inode.clone()
- }
- fn parent(&self) -> Option<Weak<dyn KObject>> {
- self.inner().kobject_common.parent.clone()
- }
- fn set_parent(&self, parent: Option<Weak<dyn KObject>>) {
- self.inner().kobject_common.parent = parent;
- }
- fn kset(&self) -> Option<Arc<KSet>> {
- self.inner().kobject_common.kset.clone()
- }
- fn set_kset(&self, kset: Option<Arc<KSet>>) {
- self.inner().kobject_common.kset = kset;
- }
- fn kobj_type(&self) -> Option<&'static dyn KObjType> {
- self.inner().kobject_common.kobj_type
- }
- fn set_kobj_type(&self, ktype: Option<&'static dyn KObjType>) {
- self.inner().kobject_common.kobj_type = ktype;
- }
- fn name(&self) -> String {
- Self::NAME.to_string()
- }
- fn set_name(&self, _name: String) {
- // 不允许修改
- warn!("fbcon name can not be changed");
- }
- fn kobj_state(&self) -> RwLockReadGuard<KObjectState> {
- self.kobj_state.read()
- }
- fn kobj_state_mut(&self) -> RwLockWriteGuard<KObjectState> {
- self.kobj_state.write()
- }
- fn set_kobj_state(&self, state: KObjectState) {
- *self.kobj_state.write() = state;
- }
- }
- impl Device for FbConsoleDevice {
- fn dev_type(&self) -> DeviceType {
- DeviceType::Char
- }
- fn id_table(&self) -> IdTable {
- IdTable::new(Self::NAME.to_string(), None)
- }
- fn set_bus(&self, bus: Option<Weak<dyn Bus>>) {
- self.inner().device_common.bus = bus;
- }
- fn bus(&self) -> Option<Weak<dyn Bus>> {
- self.inner().device_common.bus.clone()
- }
- fn set_class(&self, _class: Option<Weak<dyn Class>>) {
- // 不允许修改
- warn!("fbcon's class can not be changed");
- }
- fn class(&self) -> Option<Arc<dyn Class>> {
- sys_class_graphics_instance().map(|ins| ins.clone() as Arc<dyn Class>)
- }
- fn driver(&self) -> Option<Arc<dyn Driver>> {
- self.inner()
- .device_common
- .driver
- .clone()
- .and_then(|driver| driver.upgrade())
- }
- fn set_driver(&self, driver: Option<Weak<dyn Driver>>) {
- self.inner().device_common.driver = driver;
- }
- fn is_dead(&self) -> bool {
- self.inner().device_common.dead
- }
- fn can_match(&self) -> bool {
- self.inner().device_common.can_match
- }
- fn set_can_match(&self, can_match: bool) {
- self.inner().device_common.can_match = can_match;
- }
- fn state_synced(&self) -> bool {
- todo!()
- }
- fn attribute_groups(&self) -> Option<&'static [&'static dyn AttributeGroup]> {
- return Some(&[&AnonymousAttributeGroup]);
- }
- fn dev_parent(&self) -> Option<Weak<dyn Device>> {
- self.inner().device_common.get_parent_weak_or_clear()
- }
- fn set_dev_parent(&self, dev_parent: Option<Weak<dyn Device>>) {
- self.inner().device_common.parent = dev_parent;
- }
- }
- /// framebuffer console设备的匿名属性组
- #[derive(Debug)]
- struct AnonymousAttributeGroup;
- impl AttributeGroup for AnonymousAttributeGroup {
- fn name(&self) -> Option<&str> {
- None
- }
- fn attrs(&self) -> &[&'static dyn Attribute] {
- return &[&AttrRotate, &AttrRotateAll, &AttrCursorBlink];
- }
- fn is_visible(
- &self,
- _kobj: Arc<dyn KObject>,
- attr: &'static dyn Attribute,
- ) -> Option<ModeType> {
- return Some(attr.mode());
- }
- }
- #[derive(Debug)]
- struct AttrRotate;
- impl Attribute for AttrRotate {
- fn name(&self) -> &str {
- "rotate"
- }
- fn mode(&self) -> ModeType {
- ModeType::S_IRUGO | ModeType::S_IWUSR
- }
- fn support(&self) -> SysFSOpsSupport {
- SysFSOpsSupport::ATTR_SHOW | SysFSOpsSupport::ATTR_STORE
- }
- /// https://code.dragonos.org.cn/xref/linux-6.1.9/drivers/video/fbdev/core/fbcon.c#3226
- fn show(&self, _kobj: Arc<dyn KObject>, buf: &mut [u8]) -> Result<usize, SystemError> {
- warn!("fbcon rotate show not implemented");
- return sysfs_emit_str(buf, "0\n");
- }
- /// https://code.dragonos.org.cn/xref/linux-6.1.9/drivers/video/fbdev/core/fbcon.c#3182
- fn store(&self, _kobj: Arc<dyn KObject>, _buf: &[u8]) -> Result<usize, SystemError> {
- warn!("fbcon rotate store not implemented");
- return Err(SystemError::ENOSYS);
- }
- }
- #[derive(Debug)]
- struct AttrRotateAll;
- impl Attribute for AttrRotateAll {
- fn name(&self) -> &str {
- "rotate_all"
- }
- fn mode(&self) -> ModeType {
- ModeType::S_IWUSR
- }
- fn support(&self) -> SysFSOpsSupport {
- SysFSOpsSupport::ATTR_STORE
- }
- /// https://code.dragonos.org.cn/xref/linux-6.1.9/drivers/video/fbdev/core/fbcon.c#3204
- fn store(&self, _kobj: Arc<dyn KObject>, _buf: &[u8]) -> Result<usize, SystemError> {
- warn!("fbcon rotate_all store not implemented");
- return Err(SystemError::ENOSYS);
- }
- }
- #[derive(Debug)]
- struct AttrCursorBlink;
- impl Attribute for AttrCursorBlink {
- fn name(&self) -> &str {
- "cursor_blink"
- }
- fn mode(&self) -> ModeType {
- ModeType::S_IRUGO | ModeType::S_IWUSR
- }
- fn support(&self) -> SysFSOpsSupport {
- SysFSOpsSupport::ATTR_SHOW | SysFSOpsSupport::ATTR_STORE
- }
- /// https://code.dragonos.org.cn/xref/linux-6.1.9/drivers/video/fbdev/core/fbcon.c#3245
- fn show(&self, _kobj: Arc<dyn KObject>, _buf: &mut [u8]) -> Result<usize, SystemError> {
- todo!()
- }
- fn store(&self, _kobj: Arc<dyn KObject>, _buf: &[u8]) -> Result<usize, SystemError> {
- todo!()
- }
- }
- #[derive(Debug, Default)]
- #[allow(dead_code)]
- pub struct FrameBufferConsoleData {
- /// 光标闪烁间隔
- pub cursor_blink_jiffies: i64,
- /// 是否刷新光标
- pub cursor_flash: bool,
- pub display: FbConsoleDisplay,
- /// 光标状态
- pub cursor_state: FbCursor,
- /// 重设光标?
- pub cursor_reset: bool,
- /// cursor 位图数据
- pub cursor_data: Vec<u8>,
- }
- pub trait FrameBufferConsole {
- fn fbcon_data(&self) -> SpinLockGuard<FrameBufferConsoleData>;
- /// ## 将位块移动到目标位置
- /// 坐标均以字体为单位而不是pixel
- /// ### 参数
- /// ### sy: 起始位置的y坐标
- /// ### sx: 起始位置的x坐标、
- /// ### dy: 目标位置的y坐标
- /// ### dx: 目标位置的x坐标
- /// ### height: 位图高度
- /// ### width: 位图宽度
- #[allow(clippy::too_many_arguments)]
- fn bmove(
- &self,
- vc_data: &VirtualConsoleData,
- sy: i32,
- sx: i32,
- dy: i32,
- dx: i32,
- height: u32,
- width: u32,
- ) -> Result<(), SystemError>;
- /// ## 清除位图
- ///
- /// ### 参数
- /// ### sy: 原位置的y坐标
- /// ### sx: 原位置的x坐标、
- /// ### height: 位图高度
- /// ### width: 位图宽度
- fn clear(
- &self,
- vc_data: &VirtualConsoleData,
- sy: u32,
- sx: u32,
- height: u32,
- width: u32,
- ) -> Result<(), SystemError>;
- /// ## 显示字符串
- ///
- /// ### 参数
- /// ### y: 起始位置y坐标
- /// ### x: 起始位置的x坐标、
- /// ### fg: 前景色
- /// ### bg: 背景色
- #[allow(clippy::too_many_arguments)]
- fn put_string(
- &self,
- vc_data: &VirtualConsoleData,
- data: &[u16],
- count: u32,
- y: u32,
- x: u32,
- fg: u32,
- bg: u32,
- ) -> Result<(), SystemError>;
- fn cursor(&self, vc_data: &VirtualConsoleData, op: CursorOperation, fg: u32, bg: u32);
- }
- /// 表示 framebuffer 控制台与低级帧缓冲设备之间接口的数据结构
- #[derive(Debug, Default)]
- pub struct FbConsoleDisplay {
- /// 硬件滚动的行数
- pub yscroll: u32,
- /// 光标
- pub cursor_shape: VcCursor,
- /// 滚动模式
- pub scroll_mode: ScrollMode,
- virt_rows: u32,
- }
- impl FbConsoleDisplay {
- pub fn real_y(&self, mut ypos: u32) -> u32 {
- let rows = self.virt_rows;
- ypos += self.yscroll;
- if ypos < rows {
- return ypos;
- } else {
- return ypos - rows;
- }
- }
- }
- bitflags! {
- pub struct FbConAttr:u8 {
- const UNDERLINE = 1;
- const REVERSE = 2;
- const BOLD = 4;
- }
- }
- impl FbConAttr {
- pub fn get_attr(c: u16, color_depth: u32) -> Self {
- let mut attr = Self::empty();
- if color_depth == 1 {
- if Self::underline(c) {
- attr.insert(Self::UNDERLINE);
- }
- if Self::reverse(c) {
- attr.intersects(Self::REVERSE);
- }
- if Self::blod(c) {
- attr.insert(Self::BOLD);
- }
- }
- attr
- }
- pub fn update_attr(&self, dst: &mut [u8], src: &[u8], vc_data: &VirtualConsoleData) {
- let mut offset = if vc_data.font.height < 10 { 1 } else { 2 } as usize;
- let width = (vc_data.font.width + 7) / 8;
- let cellsize = (vc_data.font.height * width) as usize;
- // 大于offset的部分就是下划线
- offset = cellsize - (offset * width as usize);
- for i in 0..cellsize {
- let mut c = src[i];
- if self.contains(Self::UNDERLINE) && i >= offset {
- // 下划线
- c = 0xff;
- }
- if self.contains(Self::BOLD) {
- c |= c >> 1;
- }
- if self.contains(Self::REVERSE) {
- c = !c;
- }
- dst[i] = c;
- }
- }
- pub fn underline(c: u16) -> bool {
- c & 0x400 != 0
- }
- pub fn blod(c: u16) -> bool {
- c & 0x200 != 0
- }
- pub fn reverse(c: u16) -> bool {
- c & 0x800 != 0
- }
- }
|