// // 内核全局通用库 // Created by longjin on 2022/1/22. // #pragma once //引入对bool类型的支持 #include #include #define NULL 0 #define sti() __asm__ __volatile__("sti\n\t" :: \ : "memory") //开启外部中断 #define cli() __asm__ __volatile__("cli\n\t" :: \ : "memory") //关闭外部中断 #define nop() __asm__ __volatile__("nop\n\t") #define hlt() __asm__ __volatile__("hlt\n\t") //内存屏障 #define io_mfence() __asm__ __volatile__("mfence\n\t" :: \ : "memory") // 在mfence指令前的读写操作必须在mfence指令后的读写操作前完成。 #define io_sfence() __asm__ __volatile__("sfence\n\t" :: \ : "memory") // 在sfence指令前的写操作必须在sfence指令后的写操作前完成 #define io_lfence() __asm__ __volatile__("lfence\n\t" :: \ : "memory") // 在lfence指令前的读操作必须在lfence指令后的读操作前完成。 /** * @brief 根据结构体变量内某个成员变量member的基地址,计算出该结构体变量的基地址 * @param ptr 指向结构体变量内的成员变量member的指针 * @param type 成员变量所在的结构体 * @param member 成员变量名 * * 方法:使用ptr减去结构体内的偏移,得到结构体变量的基地址 */ #define container_of(ptr, type, member) \ ({ \ typeof(((type *)0)->member) *p = (ptr); \ (type *)((unsigned long)p - (unsigned long)&(((type *)0)->member)); \ }) // 定义类型的缩写 typedef unsigned char uchar; typedef unsigned short ushort; typedef unsigned int uint; typedef unsigned long ul; typedef unsigned long long int ull; typedef long long int ll; #define ABS(x) ((x) > 0 ? (x) : -(x)) // 绝对值 // 最大最小值 #define max(x, y) ((x > y) ? (x) : (y)) #define min(x, y) ((x < y) ? (x) : (y)) // 遮罩高32bit #define MASK_HIGH_32bit(x) (x & (0x00000000ffffffffUL)) // 四舍五入成整数 ul round(double x) { return (ul)(x + 0.5); } /** * @brief 地址按照align进行对齐 * * @param addr * @param _align * @return ul 对齐后的地址 */ ul ALIGN(const ul addr, const ul _align) { return (ul)((addr + _align - 1) & (~(_align - 1))); } //链表数据结构 struct List { struct List *prev, *next; }; //初始化循环链表 static inline void list_init(struct List *list) { list->next = list; list->prev = list; } /** * @brief * @param entry 给定的节点 * @param node 待插入的节点 **/ static inline void list_add(struct List *entry, struct List *node) { node->next = entry->next; node->prev = entry; node->next->prev = node; entry->next = node; } static inline void list_append(struct List *entry, struct List *node) { /** * @brief 将node添加到给定的list的结尾(也就是当前节点的前面) * @param entry 列表的入口 * @param node 待添加的节点 */ struct List *tail = entry->prev; list_add(tail, node); } static inline void list_del(struct List *entry) { /** * @brief 从列表中删除节点 * @param entry 待删除的节点 */ entry->next->prev = entry->prev; entry->prev->next = entry->next; } static inline bool list_empty(struct List *entry) { /** * @brief 判断循环链表是否为空 * @param entry 入口 */ if (entry->prev == entry->next) return true; else return false; } /** * @brief 获取链表的上一个元素 * * @param entry * @return 链表的上一个元素 */ static inline struct List *list_prev(struct List *entry) { if (entry->prev != NULL) return entry->prev; else return NULL; } /** * @brief 获取链表的下一个元素 * * @param entry * @return 链表的下一个元素 */ static inline struct List *list_next(struct List *entry) { if (entry->next != NULL) return entry->next; else return NULL; } //计算字符串的长度(经过测试,该版本比采用repne/scasb汇编的运行速度快16.8%左右) static inline int strlen(char *s) { register int __res = 0; while (s[__res] != '\0') { ++__res; } return __res; } void *memset(void *dst, unsigned char C, ul size) { int d0, d1; unsigned long tmp = C * 0x0101010101010101UL; __asm__ __volatile__("cld \n\t" "rep \n\t" "stosq \n\t" "testb $4, %b3 \n\t" "je 1f \n\t" "stosl \n\t" "1:\ttestb $2, %b3 \n\t" "je 2f\n\t" "stosw \n\t" "2:\ttestb $1, %b3 \n\t" "je 3f \n\t" "stosb \n\t" "3: \n\t" : "=&c"(d0), "=&D"(d1) : "a"(tmp), "q"(size), "0"(size / 8), "1"(dst) : "memory"); return dst; } /** * @brief 内存拷贝函数 * * @param dst 目标数组 * @param src 源数组 * @param Num 字节数 * @return void* */ void *memcpy(void *dst, void *src, long Num) { int d0, d1, d2; __asm__ __volatile__("cld \n\t" "rep \n\t" "movsq \n\t" "testb $4,%b4 \n\t" "je 1f \n\t" "movsl \n\t" "1:\ttestb $2,%b4 \n\t" "je 2f \n\t" "movsw \n\t" "2:\ttestb $1,%b4 \n\t" "je 3f \n\t" "movsb \n\t" "3: \n\t" : "=&c"(d0), "=&D"(d1), "=&S"(d2) : "0"(Num / 8), "q"(Num), "1"(dst), "2"(src) : "memory"); return dst; } void *memset_c(void *dst, unsigned char c, ul n) { unsigned char *s = (unsigned char *)dst; for (int i = 0; i < n; ++i) s[i] = c; return dst; } // 从io口读入8个bit unsigned char io_in8(unsigned short port) { unsigned char ret = 0; __asm__ __volatile__("inb %%dx, %0 \n\t" "mfence \n\t" : "=a"(ret) : "d"(port) : "memory"); return ret; } // 从io口读入32个bit unsigned int io_in32(unsigned short port) { unsigned int ret = 0; __asm__ __volatile__("inl %%dx, %0 \n\t" "mfence \n\t" : "=a"(ret) : "d"(port) : "memory"); return ret; } // 输出8个bit到输出端口 void io_out8(unsigned short port, unsigned char value) { __asm__ __volatile__("outb %0, %%dx \n\t" "mfence \n\t" : : "a"(value), "d"(port) : "memory"); } // 输出32个bit到输出端口 void io_out32(unsigned short port, unsigned int value) { __asm__ __volatile__("outl %0, %%dx \n\t" "mfence \n\t" : : "a"(value), "d"(port) : "memory"); } /** * @brief 从端口读入n个word到buffer * */ #define io_insw(port,buffer,nr) \ __asm__ __volatile__("cld;rep;insw;mfence;"::"d"(port),"D"(buffer),"c"(nr):"memory") /** * @brief 从输出buffer中的n个word到端口 * */ #define io_outsw(port,buffer,nr) \ __asm__ __volatile__("cld;rep;outsw;mfence;"::"d"(port),"S"(buffer),"c"(nr):"memory") /** * @brief 读取rsp寄存器的值(存储了页目录的基地址) * * @return unsigned* rsp的值的指针 */ unsigned long *get_rsp() { ul *tmp; __asm__ __volatile__( "movq %%rsp, %0\n\t" : "=r"(tmp)::"memory"); return tmp; } /** * @brief 读取rbp寄存器的值(存储了页目录的基地址) * * @return unsigned* rbp的值的指针 */ unsigned long *get_rbp() { ul *tmp; __asm__ __volatile__( "movq %%rbp, %0\n\t" : "=r"(tmp)::"memory"); return tmp; } /** * @brief 读取ds寄存器的值(存储了页目录的基地址) * * @return unsigned* ds的值的指针 */ unsigned long *get_ds() { ul *tmp; __asm__ __volatile__( "movq %%ds, %0\n\t" : "=r"(tmp)::"memory"); return tmp; } /** * @brief 读取rax寄存器的值(存储了页目录的基地址) * * @return unsigned* rax的值的指针 */ unsigned long *get_rax() { ul *tmp; __asm__ __volatile__( "movq %%rax, %0\n\t" : "=r"(tmp)::"memory"); return tmp; } /** * @brief 读取rbx寄存器的值(存储了页目录的基地址) * * @return unsigned* rbx的值的指针 */ unsigned long *get_rbx() { ul *tmp; __asm__ __volatile__( "movq %%rbx, %0\n\t" : "=r"(tmp)::"memory"); return tmp; } // ========= MSR寄存器组操作 ============= /** * @brief 向msr寄存器组的address处的寄存器写入值value * * @param address 地址 * @param value 要写入的值 */ void wrmsr(ul address, ul value) { __asm__ __volatile__("wrmsr \n\t" ::"d"(value >> 32), "a"(value & 0xffffffff), "c"(address) : "memory"); } /** * @brief 从msr寄存器组的address地址处读取值 * rdmsr返回高32bits在edx,低32bits在eax * @param address 地址 * @return ul address处的寄存器的值 */ ul rdmsr(ul address) { unsigned int tmp0, tmp1; __asm__ __volatile__("rdmsr \n\t" : "=d"(tmp0), "=a"(tmp1) : "c"(address) : "memory"); return ((ul)tmp0 << 32) | tmp1; }