#include <DIP-Switch Keycode pic16f628A.h>


int8 pressed[] = {10,10,10,10};      //Съхранява бутоните, които са натиснати
int8 key[] = {10,10,10,10};         // съхранява ключа
int8 row = 10;                       //редове
int8 column = 0;                    // колони
int8 num = 0;                      // колко бутона са натиснати
int8 demux[]={8,9,10,11};           //числа отговарящи на таблицата на истиност
                                    // на демултиплексора + 1 бит за захранване
                                    // на демултилексора

void out()                           
{

if (column==0) output_b(6);          // подава нула само на един ред
if (column==1) output_b(5);          //на останалите редове - единица
if (column==2) output_b(3);
 
}
 
void read()                           //четене на редовете
{
  int i;
  int in = 0;
  for (i=0;i<4;i++)
  {
    in = 8*6 + 3 + i;               //за извеждане на високо/ниско ниво на даден пин, използвам адреса на пина.
    if (input(in)==0)              //проверка за нула на дадения ред
    {
      delay_ms(32);               //елиминиране на претрепвания
      if (input(in)==0)           //запаметяване на числото
      {
      while(input(in)==0)
      {
        row = i;                 
      }
      }
    }
  }
}

void press()
{
   if(num<4)
   {
   
   pressed[num] = (column+1) + 3*row;              //формула за изчисляване позицията на бутона
   if(pressed[num] == 11) pressed[num] = 0;         //за нулата има изключение
   num++;
    }
}

void valid()                                     //функция за отключване/заключване
{
  int i;
  int sum=0;
  for(i=0;i<4;i++)
  {
    sum = key[i] - pressed[i];
    pressed[i]=10;
  }
  if (sum == 0) output_toggle(47);           //ако на изходния пин имаме 1 ще стане нула и обратно.
  num = 0;
}

void start()                               //ф-ция за четене на DIP-switches
{
   
int8 i,inb,ina,outa;
for(num=0;num<4;num++)                    //4 цифри
{
    outa = demux[num];                     //управление на демултиплексора
    output_a(outa);
    delay_ms(10);
  for(i=0;i<8;i++)
  {
   
   inb = 6*8 + i;
   if(input(inb)==0)
     {
        delay_ms(32);
        if(input(inb) == 0) key[num] = i;
     } 
   }
   if(key[num] == 10)
   {
   
     ina = 46;
     if(input(ina)==0)
     {
       delay_ms(32);
       if(input(ina)==0) key[num] = 8;
     }
     
   } 
     delay_ms(10);
  }
  num = 0;
  output_low(PIN_A3);
}
void main()
{
   setup_oscillator(OSC_4MHZ);
   port_b_pullups(0xFF);        //вътрешните пул-ъп резистори
   set_tris_a(0x40);
   SET_TRIS_B(0xFF);
   delay_ms(10);
   start();
   delay_ms(10);
   SET_TRIS_B(0xF8);
   set_tris_a(0x00);
   output_a(0);
   delay_ms(10);
   
   while(true)
   {
     if(num<4)
     {
       for(column=0;column<3;column++)
       {
         out();
         read();
         if(row!=10)
         {
          press();
          row=10;
         }
       }
     
     }
    else valid();
   
     row = 10;
   
         
   }
     
}