#include <includes.h>
#include "keyboard.h"
#include "app_serv.h"


#define   KBRD_QUERY_LEN      4

OS_STK  KbrdTaskStk[KBRD_TASK_STK_SIZE];
OS_EVENT  *KbrdQuery = NULL;
void     *KbrdTbl[KBRD_QUERY_LEN];


void  KbrdTask(void *p_arg);

unsigned long kbrd_state;

void InitKbrd()
{
 // проинициализируем порты
/*      
P0.28	MK_P24	«1»
P0.27	MK_P25	«2»
P3.26	MK_P26	«3»
P3.25	MK_P27	«a»
P1.18	MK_P32	«b»
P1.19	MK_P33	«c»
*/
    
  // подсветка кнопки OK
  PINSEL3_bit.P1_21 = 0x0;
  PINMODE3_bit.P1_21 = 0;
  FIO1DIR_bit.P1_21 = 1;
  FIO1MASK_bit.P1_21 = 0;
  FIO1CLR_bit.P1_21 = 1;
  
  // сканирующие линии
  PINSEL1_bit.P0_28 = 0x0;
  PINSEL1_bit.P0_27 = 0x0;
  PINSEL7_bit.P3_26 = 0x0;

  PINMODE1_bit.P0_28 = 0;
  PINMODE1_bit.P0_27 = 0;
  PINMODE7_bit.P3_26 = 0;
    
  FIO0DIR_bit.P0_28 = 1;
  FIO0DIR_bit.P0_27 = 1;
  FIO3DIR_bit.P3_26 = 1;

  FIO0MASK_bit.P0_28 = 0;
  FIO0MASK_bit.P0_27 = 0;
  FIO3MASK_bit.P3_26 = 0;
  
  // входные линии
  PINSEL3_bit.P1_18 = 0x0;
  PINSEL3_bit.P1_19 = 0x0;
  PINSEL7_bit.P3_25 = 0x0;

  PINMODE3_bit.P1_18 = 0;
  PINMODE3_bit.P1_19 = 0;
  PINMODE7_bit.P3_25 = 0;
    
  FIO1DIR_bit.P1_18 = 0;
  FIO1DIR_bit.P1_19 = 0;
  FIO3DIR_bit.P3_25 = 0;

  FIO1MASK_bit.P1_18 = 0;
  FIO1MASK_bit.P1_19 = 0;
  FIO3MASK_bit.P3_25 = 0;

  // кнопка пользователя  
  PINSEL3_bit.P1_20 = 0x0;
  PINMODE3_bit.P1_20 = 0;
  FIO1DIR_bit.P1_20= 0;
  FIO1MASK_bit.P1_20 = 0;
  
  kbrd_state = 0;
  
  // создадим очередь событий клавиатуры и задачу опроса клавиатуры
  if (KbrdQuery == NULL)
    {
      KbrdQuery = OSQCreate(&KbrdTbl[0], KBRD_QUERY_LEN);
      OSTaskCreate(KbrdTask, (void *)0, (OS_STK *)&KbrdTaskStk[KBRD_TASK_STK_SIZE-1], KBRD_TASK_PRIO);
    }
}

#define KBRD_SCAN_LINE1()  {FIO0CLR_bit.P0_28 = 1; FIO0SET_bit.P0_27 = 1; FIO3SET_bit.P3_26 = 1;}
#define KBRD_SCAN_LINE2()  {FIO0SET_bit.P0_28 = 1; FIO0CLR_bit.P0_27 = 1; FIO3SET_bit.P3_26 = 1;}
#define KBRD_SCAN_LINE3()  {FIO0SET_bit.P0_28 = 1; FIO0SET_bit.P0_27 = 1; FIO3CLR_bit.P3_26 = 1;}

void  KbrdTask(void *p_arg)
{
  unsigned long prew_state = 0;
  
  while (1)
    {
      unsigned long state;
      
      OSTimeDly(17);

      state = 0;      
      KBRD_SCAN_LINE1();
      OSTimeDly(1);
      if (!FIO3PIN_bit.P3_25) state |= (1UL << KEY_F1);
      if (!FIO1PIN_bit.P1_18) state |= (1UL << KEY_F2);
      if (!FIO1PIN_bit.P1_19) state |= (1UL << KEY_F3);
      KBRD_SCAN_LINE2();
      OSTimeDly(1);
      if (!FIO3PIN_bit.P3_25) state |= (1UL << KEY_LEFT);
      if (!FIO1PIN_bit.P1_18) state |= (1UL << KEY_UP);
      if (!FIO1PIN_bit.P1_19) state |= (1UL << KEY_RIGHT);
      KBRD_SCAN_LINE3();
      OSTimeDly(1);
      if (!FIO3PIN_bit.P3_25) state |= (1UL << KEY_STOP);
      if (!FIO1PIN_bit.P1_18) state |= (1UL << KEY_DOWN);
      if (!FIO1PIN_bit.P1_19) state |= (1UL << KEY_START);

      if (!FIO1PIN_bit.P1_20) state |=  (1UL << KEY_USER_START);

      if (prew_state == state)
        { // устранили дребезг
          if (kbrd_state ^ state)
            { // есть изменения нажатия
              for (unsigned long i = 0; i < KEY_COUNT; i++)
                {
                  // ловим передний фронт при нажатии
                  if (!(kbrd_state & (1UL << i)) && (state & (1UL << i)))
                    {
                      OSQPost(KbrdQuery, (void *)i);
                      PostUserEvent(EVENT_KEY_EMPTY+i); // пользователю тоже постим
                    }
                }
            }
          kbrd_state = state;
        }
      
      prew_state = state;
    }
    
}

int GetKbrdEvent(int* event)
{
  CPU_INT08U err = 0; 
  int evt  = (int)OSQPend(KbrdQuery, 1, &err);
  if (err != 0) return 0;
  *event = evt;
  return 1;  
}