--- /dev/null
+\r
+#include "core.h"\r
+\r
+UI_TimerControl timerctrl;\r
+\r
+void Initialise_ProgrammableIntervalTimer(void)\r
+{\r
+ UI_Timer *watch;\r
+\r
+ IO_Out8(PIT_CTRL, 0x34);\r
+ IO_Out8(PIT_CNT0, 0x9c);\r
+ IO_Out8(PIT_CNT0, 0x2e);\r
+ System_GateDescriptor_Set(0x20, (uint)asm_InterruptHandler20, 0x02, AR_INTGATE32);\r
+ IO_Out8(PIC0_IMR, IO_In8(PIC0_IMR) & 0xfe);\r
+ timerctrl.count = 0;\r
+ watch = Timer_Get(0, 0);\r
+ watch->timeout = 0xFFFFFFFF;\r
+ watch->count = 0xFFFFFFFF;\r
+ watch->state = inuse;\r
+ timerctrl.next = watch;\r
+ timerctrl.ts = 0;\r
+\r
+ return;\r
+}\r
+\r
+void InterruptHandler20(int *esp)\r
+{\r
+ UI_Timer *tree, *old;\r
+ bool taskswitch;\r
+\r
+ IO_Out8(PIC0_OCW2, 0x60); /* IRQ-00\8eó\95t\8a®\97¹\82ðPIC\82É\92Ê\92m \81B0x60+\94Ô\8d\86\81B*/\r
+ timerctrl.count++;\r
+ taskswitch = false;\r
+\r
+ if(timerctrl.count == timerctrl.next->timeout){ //\8e\9e\8aÔ\82É\82È\82Á\82½\r
+ tree = timerctrl.next;\r
+ timerctrl.next = timerctrl.next->next;\r
+ for(;;){ //\93¯\88ê\83^\83C\83\80\83A\83E\83g\82ð\92T\82·\81B\r
+ if(tree->fifo != 0){ //FIFO\82Ì\91\97\90M\90æ\82ª\97L\8cø\82©\83`\83F\83b\83N\r
+ FIFO32_Put(tree->fifo, tree->data);\r
+ } else if(tree == timerctrl.ts){\r
+ taskswitch = true;\r
+ }\r
+ old = tree;\r
+ tree = old->tree;\r
+ old->tree = 0; //\93¯\88ê\83^\83C\83\80\83A\83E\83g\82È\82µ\r
+ old->state = configured; //\90Ý\92è\8dÏ\82Ý\r
+ if(old->mode == interval){ //\8cJ\82è\95Ô\82·\82È\82ç\r
+ Timer_Run(old);\r
+ }\r
+ if(tree == 0){ //\82à\82¤\93¯\88ê\83^\83C\83\80\83A\83E\83g\82Í\82È\82¢\r
+ break;\r
+ }\r
+ }\r
+ }\r
+ if(taskswitch){\r
+ MultiTask_TaskSwitch();\r
+ }\r
+ return;\r
+}\r
+\r
+uint Timer_Get_Tick(void)\r
+{\r
+ return timerctrl.count;\r
+}\r
+\r
+UI_Timer *Timer_Get(DATA_FIFO *fifo, uint data)\r
+{\r
+ UI_Timer *timer;\r
+\r
+ timer = MemoryBlock_Allocate_System(sizeof(UI_Timer));\r
+ MemoryBlock_Write_Description(timer, "UI_Timer");\r
+\r
+ timer->next = 0;\r
+ timer->tree = 0;\r
+ timer->timeout = 0;\r
+ timer->count = 0;\r
+ timer->fifo = fifo;\r
+ timer->data = data;\r
+ timer->state = initialized;\r
+ return timer;\r
+}\r
+\r
+void Timer_Set(UI_Timer *timer, uint count, timer_mode mode)\r
+{\r
+ timer->count = count;\r
+ timer->mode = mode;\r
+ timer->state = configured;\r
+ return;\r
+}\r
+\r
+void Timer_Run(UI_Timer *timer)\r
+{\r
+ UI_Timer **target;\r
+ uint eflags;\r
+\r
+ if(timer->count == 0){\r
+ return;\r
+ }\r
+\r
+ if(timer->state == inuse){\r
+ return;\r
+ }\r
+\r
+ eflags = IO_Load_EFlags();\r
+ IO_CLI();\r
+\r
+ timer->timeout = timer->count + timerctrl.count;\r
+ target = &timerctrl.next;\r
+ for(;;){\r
+ if((*target)->timeout > timer->timeout){\r
+ timer->next = *target; //\8e©\95ª\82Ì\8e\9f\82Ì\83^\83C\83}\81[\82ð\8ew\82·\r
+ *target = timer; //\8e©\95ª\82ð\91O\82Ì\83^\83C\83}\81[\82É\98A\8c\8b\r
+ timer->tree = 0; //\8e©\95ª\82ªroot\r
+ timer->state = inuse; //\93®\8dì\92\86\r
+ break;\r
+ }\r
+ if((*target)->timeout == timer->timeout){\r
+ target = &(*target)->tree;\r
+ for(;;){\r
+ if(*target == 0){\r
+ break; //\93¯\8e\9e\8d\8f\82Ì\8dÅ\8cã\82ð\92T\82·\r
+ }\r
+ target = &(*target)->tree;\r
+ }\r
+ timer->next = 0; //\8fí\82É0\r
+ *target = timer;//\8e©\95ª\82ð\91O\82Ì\83^\83C\83}\81[\82É\98A\8c\8b\r
+ timer->tree = 0; //\8e©\95ª\82ª\8fI\92[\r
+ timer->state = inuse; //\93®\8dì\92\86\r
+ break;\r
+ }\r
+ target = &(*target)->next;\r
+ }\r
+ IO_Store_EFlags(eflags);\r
+ return;\r
+}\r
+\r
+void Timer_Cancel(UI_Timer *timer)\r
+{\r
+ UI_Timer **root, **tree;\r
+ uint eflags;\r
+\r
+ eflags = IO_Load_EFlags();\r
+ IO_CLI();\r
+\r
+ root = &timerctrl.next;\r
+\r
+ for(;;){\r
+ if((*root) == 0){ /*\83\8b\81[\83g\82Ì\8fI\92[*/\r
+ return;\r
+ }\r
+ if((*root) == timer){ /*\83\8b\81[\83g\83^\83C\83}\81[\82ð\83L\83\83\83\93\83Z\83\8b*/\r
+ if((*root)->tree == 0){ /*\83c\83\8a\81[\82È\82µ*/\r
+ *root = timer->next;\r
+ } else{ /*\83c\83\8a\81[\82 \82è*/\r
+ *root = timer->tree;\r
+ timer->tree->next = timer->next;\r
+ }\r
+ goto cancel;\r
+ } else{\r
+ tree = &(*root)->tree;\r
+ for(;;){\r
+ if((*tree) == 0){ /*\83c\83\8a\81[\82Ì\8fI\92[*/\r
+ break;\r
+ }\r
+ if((*tree) == timer){ /*\83c\83\8a\81[\83^\83C\83}\81[\82ð\83L\83\83\83\93\83Z\83\8b*/\r
+ *tree = timer->tree;\r
+ goto cancel;\r
+ }\r
+ tree = &(*tree)->tree;\r
+ }\r
+ }\r
+ root = &(*root)->next;\r
+ }\r
+\r
+cancel:\r
+ timer->next = 0;\r
+ timer->tree = 0;\r
+ timer->timeout = 0;\r
+ timer->state = configured;\r
+\r
+ IO_Store_EFlags(eflags);\r
+ return;\r
+}\r
+\r
+void Timer_TaskSwitch_Set(UI_Timer *ts)\r
+{\r
+ timerctrl.ts = ts;\r
+ return;\r
+}\r
OSDN Git Service
