Приглашаю волонтёров - помочь написать ОС

/*pm.SМенеджер процессов (Process Manager) - обработчик прерывания 13 от таймера 1.*/#define __ASM__#define __SYS__#include "../blackfin/defBF532.h"#include "kernel.h"#include "api.h"#include "pll.h".extern __pm;.type __pm,function;.section .text,"ax";.align 2;.globl _pm;.type _pm,function;_pm://;сохраняем регистры в текущий стек супервизора   [--SP] = FP;   [--SP] = ASTAT;   [--SP] = (R7:0,P5:0);//;сохраняем регистры в пользовательский стек   [--USP] = FP;   [--USP] = ASTAT;   [--USP] = (R7:0,P5:0);//;запретим прерывание 13   P0 = IMASK;   R0 = [P0];   BITCLR(R0,13);   [P0] = R0;//;Следующий блок лишний, т.к. таймер запускается в режиме одиночного импульса//;достаточно запретить прерывание 13, выключить таймер и сбросить событие/*//;запретим прерывания от таймера 1   P0 = SIC_IMASK;   R0 = [P0];//   R0 &= ~TIMER1_IRQ;   BITCLR(R0,17);   [P0] = R0;*///;выключим таймер   P0 = TIMER_DISABLE;   R0 = TIMDIS1;   [P0] = R0;//;принудительно остановим таймер   P0 = TIMER_STATUS;   R0 = TIMIL1 | TRUN1;   [P0] = R0;//;загружаем в P0 адрес описателя прерванного потока   P0 = __curthr;   P0 = [P0];//;определяем, в каком режиме работал прерванный поток   R0 = B([P0+THR_FLAG_OFFSET])(Z);//_curthr->flag   R1 = THR_FLAG_SYSCALL | THR_FLAG_SYSTEM;   R2 = R0&R1;   CC = R2==0x0;   R2 = 0x40(Z);//для инкрементирования указателя стека   IF CC JUMP prevthr_user_mode;//;прерванный поток работал в режиме супервизора, восстановим пользовательский стек   R1 = USP;   R1 += R2;   USP = R1;   R1 = SP;//запомним вершину стека супервизора   JUMP prevthr_common;//;прерванный поток работал в пользовательстом режиме, восстановим стек супервизораprevthr_user_mode:   R1 = SP;   R1 += R2;   SP = R1;   R1 = USP;//запомним вершину пользовательского стекаprevthr_common:   [P0++] = R1;//сохранили вершину стека в структуру   R1 = RETI;//сюда надо будет вернуться, когда до этого потока снова дойдет очередь   [P0] = R1;//сохранили адрес возврата в структуру   [--SP] = R0;//сохранили флаг предыдущего потока в стек супервизора   [--SP] = RETS;//сохранили адрес возврата из подпрограммы   CALL __pm;//вызвали Process Manager, написанный на C (kernel.c)   RETS = [SP++];//восстановили адрес возврата   R3 = [SP++];//теперь в R3 флаг предыдущего потока    CC = R0==0x0;//функция вернула NULL - следующий поток не существует   IF CC JUMP _dummy;//вешаем систему (потом напишу принудительную перезагрузку)   P0 = R0;//_pm(void) возвращает указатель на описатель потока, который должен быть запущен   R0 = B([P0+THR_FLAG_OFFSET])(Z);//в R0 флаг следующего потока   CC = BITTST(R3,THR_BIT_SYSCALL);//CC истинно, если пред.поток работал в сисвызове   IF CC JUMP prthr_sc;   CC = BITTST(R3,THR_BIT_SYSTEM);//CC истинно, если поток был системным   IF CC JUMP prthr_sys;   CC = BITTST(R0,THR_BIT_SYSCALL);//CC истинно, если новый поток должен выполнять сисвызов   IF CC JUMP from_any_to_sc;   CC = BITTST(R0,THR_BIT_SYSTEM);//CC истинно, если новый поток должен стать системным   IF CC JUMP from_user_to_sys;enter_user_mode://;возврат в пользовательский режим - активно ровно одно прерывание   USP = [P0++];//восстановление указателя пользовательского стека из описателя   RETI = [P0];//восстановление точки возврата из прерывания   [--USP] = RETS;//сохраняем текущий адрес возврата из подпрограммы в стек   CALL _allow_pm;//вычисляем период, разрешаем прерывание 13   RETS = [USP++];//восстанавливаем адрес возврата   (R7:0,P5:0) = [USP++];//восстанавливаем регистры из пользовательского стека   ASTAT = [USP++];   FP = [USP++];   RTI;//сбрасывается последнее активное прерываниеfrom_any_to_sc://;перейти из любого режима, ниже сисвызова, в режим сисвызова   RETI = _dummy;//пользовательский режим не будет обрабатываться процессором   SP = [P0++];//восстанавливаем указатель стека супервизора из описателя   P1 = EVT14;//обработчик 14-го прерывания (сисвызов)   R1 = [P0];//назначаем по адресу возврата в поток   [P1] = R1;   RAISE 14;//возбуждаем 14-е прерывание (не было активно)enter_sys_mode://;возврат в режим обработки прерывания   [--SP] = RETS;//сохраняем адрес возврата из подпрограммы в стек супервизора   CALL _allow_pm;//вычисляем период, разрешаем прерывание 13   RETS = [SP++];//восстанавливаем адрес возврата   (R7:0,P5:0) = [SP++];//восстанавливаем регистры   ASTAT = [SP++];   FP = [SP++];   RTI;//еще как минимум одно прерывание активноfrom_user_to_sys://;переход из пользовательского режима в системный   RETI = _dummy;//работы в пользовательском режиме не будет   SP = [P0++];//восстановили указатель стека супервизора из описателя   P1 = EVT15;//адресом обработчика 15-го прерывания (системный режим)   R1 = [P0];//становится текущая точка входа в поток   [P1] = R1;   RAISE 15;//возбждается прерывание 15 (было не активно)   JUMP enter_sys_mode;prthr_sys://;предыдущий поток был системным   CC = BITTST(R0,THR_BIT_SYSCALL);//следующий поток выполняет сисвызов   IF CC JUMP from_any_to_sc;//все переходы в режим сисвызова выполняются одинаково   CC = BITTST(R0,THR_BIT_SYSTEM);//следующий поток тоже системный   IF CC JUMP save_int_level;//нужно оставить 15-е прерывание активнымfrom_sys_to_user://;перейти от системного режима к пользовательскому   RETI = enter_user_mode;   RTI;//останется активным ровно одно прерываниеsave_int_level://;остаться на прежнем уровне прерывания   SP = [P0++];//восстанавливаем указатель стека супервизора   RETI = [P0];//назначаем адрес возврата из Менеджера Процессов   JUMP enter_sys_mode;prthr_sc://;предыдущий поток выполнял сисвызов   CC = BITTST(R0,THR_BIT_SYSCALL);//следующий поток тоже выполняет сисвызов   IF CC JUMP save_int_level;//останемся в 14-м прерывании   CC = BITTST(R3,THR_BIT_SYSTEM);//предыдущий поток был системный и выполнял сисвызов   IF CC JUMP prthr_sc_sys;   CC = BITTST(R0,THR_BIT_SYSTEM);//следующий поток - системный   IF ! CC JUMP from_sys_to_user;//следующий поток - пользовательскийfrom_sc_to_sys://;переход из чистого сисвызова в системный поток   RETI = from_user_to_sys;   RTI;//возврат в 14-е прерывание, 15-е будет назначеноprthr_sc_sys://;предыдущий поток был системный и выполнял сисвызов   CC = BITTST(R0,THR_BIT_SYSTEM);//следующий поток тоже системный, но без сисвызова   IF CC JUMP from_sc_sys_to_sys;//from_sc_sys_to_user://;переход из системного потока с сисвызовом в пользовательский   RETI = from_sys_to_user;   RTI;//возврат в 14-е прерывание, 15 остается активнымfrom_sc_sys_to_sys://;переход из системного потока с сисвызовом в просто системный   RETI = save_int_level;   RTI;//возврат в 14-е прерывание, 15 остается активным//;КОНЕЦ функции _pm//;Подпрограмма, устанавливающая период таймера и разрешающая прерывания_allow_pm://;в P0 передан указатель на описатель следующего потока +4 (указатель на адрес точки возврата)//;в R0 передан флаг следующего потока (не понадобится)   R1 = B([P0+(THR_FREQ_OFFSET-4)])(Z);//поле freq - величина, обратная кванту процессорного времени   CC = R1==0x0;   IF CC JUMP allow_int;//таймер не требуется, поток сам отдаст управление (режим реального времени)//;вычислим и установим период таймера//;Период таймера равен FREQ_SCLK/TIMERx_PERIOD секунд//;Если TIMER1_PERIOD = FREQ_SCLK >> _curthr->freq,//;то _curthr->quant - это двоичный логарифм частоты срабатывания.//;quant - примерное время (частота) - количетво тактов при FREQ_CORE = 400 МГц (393216000 Гц)//;1 - 1 с (1 Гц) - 393216000//;2 - 500 мс (2 Гц) - 196608000//;3 - 250 мс (4 Гц) - 98304000//;4 - 125 мс (8 Гц) - 49152000//;5 - 63 мс (16 Гц) - 24576000//;6 - 31 мс (32 Гц) - 12288000//;7 - 16 мс (64 Гц) - 6144000//;8 - 8 мс (128 Гц) - 3072000//;9 - 4 мс (256 Гц) - 1536000//;10 - 2 мс (512 Гц) - 768000 (значение по умолчанию)//;11 - 1 мс (1 кГц) - 384000//;12 - 488 мкс (2 кГц) - 192000//;13 - 244 мкс (4.1 кГц) - 96000//;14 - 122 мкс (8.2 кГц) - 48000//;15 - 61 мкс (16.4 кГц)- 24000//;16 - 30 мкс (32.8 кГц) - 12000//;17 - 15 мкс (65.5 кГц) - 6000//;18 - 8 мкс (131.1 кГц) - 3000//;19 - 4 мкс (262.1 кГц) - 1500//;20 - 2 мкс (524.3 кГц) - 750//;20 - максимально допустимое системой значение поля freq   P0 = TIMER1_PERIOD;   R0 = FREQ_SCLK;   R0 >>= R1;   [P0] = R0;//;Следующий блок лишний, т.к. прерывание от таймера 1 всегда разрешено.   /*//;разрешим прерывания от таймера 1   P0 = SIC_IMASK;   R0 = [P0];//   R0 |= TIMER1_IRQ;   BITSET(R0,17);   [P0] = R0;*///;включим таймер   P0 = TIMER_ENABLE;   R0 = TIMEN1;   [P0] = R0;allow_int://;разрешим прерывание 13   P0 = IMASK;   R0 = [P0];   BITSET(R0,13);   [P0] = R0;   RTS;//;КОНЕЦ подпрограммы _allow_pm//;Вечно ожидающая функция_dummy:   IDDLE;   JUMP _dummy;//;КОНЕЦ функции _dummy#undef __SYS__#undef __ASM__

/*kernel.cЯдро системы.*/#ifndef _KERNEL_C#define _KERNEL_C#define __SYS__#include "../blackfin/cdefBF532.h"#include "kernel.h"#include "api.h"#include "syscall.h"#define switch_to_next_thread( )   asm("RAISE 13;")[тут дальше еще много чего написано]//Менеджер Процессов (фрагмент)//возвращает указатель на описатель потока, в который нужно передать управлениеvoid *_pm() {register unsigned int tind;register unsigned short i,tmp;if((_curthr->flag&THR_FLAG_NEXT)&&(_nexttid)) tind=_thr_find(_nexttid);//явно указан поток, к которому надо перейтиelse tind=THR_TAB_SIZE;//не указан или не найден_curthr->flag&=~THR_FLAG_NEXT;if(tind==THR_TAB_SIZE) {   tind=_curthr-_thrtab;//индекс только что прерванного потока   tind++;//перейдем к следующему потоку}if(tind==_qthr) tind=0;//если предыдущий был последним, перейдем в началоfor(i=tind;i<_qthr;i++) {//будем искать следующий незавершившийся поток   if(_thrtab[i].flag&THR_FLAG_EXIT) _pm_flag|=PM_THR_FLAG;//если есть завершившиеся, поставим флаг уплотнения   else break;//иначе прервемся}if(i==_qthr) {//дошли до конца   for(i=0;i<tind;i++) if(!(_thrtab[i].flag&THR_FLAG_EXIT)) break;//ищем незавершившийся сначала   if(i==tind) return(NULL);//абсолютно все потоки завершились!}if(_pm_flag&PM_THR_FLAG) {//проверим, нужно ли уплотнить таблицу потоков   switch(_thr_mutex) {//проверим мутекс   case 0xFFFF://уже захвачен      if(_thr_sem==0) {//если никто не читает таблицу         tmp=_thrtab[i].tid;//запомним идентификатор следующего потока         _qthr=pack_tab((void *)_thrtab,_qthr,sizeof(THR_ITEM),THR_FLAG_OFFSET,THR_FLAG_EXIT);//уплотним таблицу         _thr_mutex=0;//освободим мутекс         _pm_flag&=~PM_THR_FLAG;//сбросим флаг уплотнения         tind=_thr_find(tmp);//найдем индекс следующего потока в обновленной таблице         if(tind==THR_TAB_SIZE) return(NULL);//поток не найден - фатальная ошибка!      }      break;   case 0x0000: _thr_mutex=0xFFFF;//свободен - захватим; уплотнять начнем в следующий раз   }}if(_pm_flag&PM_EVT_FLAG) {//проверим, нужно ли уплотнить таблицу событий   switch(_evt_mutex) {//проверим мутекс   case 0xFFFF://уже захвачен      if(_evt_sem==0) {//если никто не читает таблицу         _qevt=pack_tab((void *)_evttab,_qevt,sizeof(EVT_ITEM),EVT_FLAG_OFFSET,EVT_FLAG_DONE);//уплотним таблицу         _evt_mutex=0;//освободим мутекс         _pm_flag&=~PM_EVT_FLAG;//сбросим флаг уплотнения      }      break;   case 0x0000: _evt_mutex=0xFFFF;//свободен - захватим; уплотнять начнем в следующий раз   }}//!!!-возможно, понадобится уплотнять _filtab и _reltabwhile(1) {//будем просматривать таблицу, пока не найдем, кому передать управление   if(tind>=_qthr) tind=0;//если последний - начнем с начала   if((_thrtab[tind].flag&(THR_FLAG_EXIT|THR_FLAG_SLEEP))==0) break;//нашли неспящий и незавершившийся поток   tind++;//перейдем к следующему}_curthr=&_thrtab[tind];return(_curthr);}//================#undef __SYS__#endif /* _KERNEL_C */