trigger.c

См. документацию.

 
#include <io/ports.h>
#include <io/status_loggers.h>
#include <lib/stdio.h>
#include <sys/trigger.h>
#include <drv/input/keymap.h>
#include "sys/scheduler.h"
#include "sys/timer.h"
 
trigger_t Triggers[1024] = {0};     
size_t TriggersCount = 0;           
 
int _FoundFreeIndexTrigger(){
    for(int i = 0; i < 1024; i++){
        if (Triggers[i].is_not_delete == 0) return i;
    }
    return -1;
}
 
int RegTrigger(int type,trigger_cmd_t handler){
    qemu_log("[Trigger] An attempt to register trigger '%x' was detected.",type);
    int idx = _FoundFreeIndexTrigger();
    if (idx == -1) {
        qemu_err("[Trigger] ERROR NO FREE TRIGGERS SPACE!!");
        return -1;
    }
    Triggers[idx].index = TriggersCount;
    Triggers[idx].type = type;
    Triggers[idx].ready = 1;
    Triggers[idx].is_not_delete = 1;
    Triggers[idx].cmd = handler;
    qemu_ok("[Trigger] Format %x trigger has successfully registered and has index number %d.",type,idx);
    TriggersCount++;
    return idx;
}
 
void DeleteTrigger(int index){
    if (index > 1024 || Triggers[index].is_not_delete == 0){
        qemu_err("[Trigger] Unknown #%d trigger",index);
        return;
    }
    qemu_log("[Trigger] Trigger #%d has been deleted",index);
    Triggers[index].is_not_delete = 0;
    Triggers[index].ready = 0;
}
 
void OnTrigger(int index){
    if (index > 1024 || Triggers[index].is_not_delete == 0){
        qemu_err("[Trigger] Unknown #%d trigger",index);
        return;
    }
 
    Triggers[index].ready = 1;
}
 
void OffTrigger(int index){
    if (index > 1024 || Triggers[index].is_not_delete == 0){
        qemu_err("[Trigger] Unknown #%d trigger",index);
        return;
    }
    qemu_log("[Trigger] Trigger #%d has been disabled",index);
    Triggers[index].ready = 0;
}
 
void CallTrigger(int type, void* data1, void* data2, void* data3, void* data4, void* data5){
    for (size_t inx = 0; inx < TriggersCount; inx++){
        //if (log) qemu_log("[Trigger] Scan: %d | Type: %x | Ready: %d",inx,Triggers[inx]->type,Triggers[inx]->ready);
        if (type == Triggers[inx].type && Triggers[inx].ready){
            Triggers[inx].cmd(data1, data2, data3, data4, data5);
        }
    }
}
 
void triggersConfig(){
    qemu_log("[Trigger] Configurate...");
 
    //Triggers = kmalloc(sizeof(trigger_t)*1024);   ///< Выделяем память на триггеры
}