Subversion Repositories f9daq

/*
 * data_handling.c
 *
 *  Created on: 18. dec. 2018
 *      Author: Domen
 */

#include <stdint.h>
#include "data_handling.h"
#include <sys/mman.h>


/*----------------------------------STATIC FUNCTIONS PROTOTYPES---------------------------------*/

uint32_t read__value(uint32_t *addr);
void write_value (uint32_t *addr, uint32_t value);











/* -----------------------------------------STATIC (PRIVATE) FUNCTIONS----------------------------------*/


uint32_t read_value(uint32_t *addr) //mogoce dodaj *
{


        uint32_t result = 0;

        result = *(addr);

        return result;
}



void write_value(uint32_t *addr, uint32_t value)
{
        *addr = value;
}







/*-----------------------------------------PUBLIC FUNCTIONS----------------------------------*/

uint32_t *HW_init(void)
{

        void *map_base = (void *)(-1);  //naslov, kjer se mi zacne mapiran spomin
        static void *virt_addr;
        int fd = -1; //file descriptor



        //odpiram svoj file
        if ( (fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1 )
        {
                perror("ERROR: open."); //sporoci napako, ce ni OK odprl
        }


        //mapiram memmory v zgoraj odprtem file-u in preverjam, ce se je OK odprl
        map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, HW_address & ~MAP_MASK); //zakaj ni tukaj za offset kar samo HW_address

        if(map_base == (void *) -1)
        {
                perror("ERROR: mmap ni pravilno lociral spomina");
        }

        printf("MAP_BASE: %p\n",map_base);
        virt_addr = map_base + (HW_address & MAP_MASK); //ne vem, ce to potrebno, ker bi moral ze v map_base imeti pravi naslov
        virt_addr = (uint32_t *)virt_addr; //castam na uint32_t, da ga read_value lahko sprejme


        /* map base bi mi ze  moral vrniti moj pravi HW_naslov, se pravi 0x40500000, ker
         * v funkciji mmap dodam offset, kje naj locira pomnilnik: zaène na NULL v /dev/mem, offset pa je HW_address & ~MAP_MASK
         * kar je enako 0x40500000, maska poskrbi samo za to, da je spodnjih 12 bitov na 0, ker so memory blocks poravnani na
         * zaèetek strani (glej tole: https://www.youtube.com/watch?v=XV5sRaSVtXQ at 5.20)
         *
         *
         */



        return virt_addr;
}





uint8_t HW_comm ( HW_system *strct, uint32_t *reg_addr)
{
        uint32_t HW_write = 0;
        uint32_t HW_read = 0;


        if ( (strct -> HW_config_flag) == 1 )
        {
                //pisanje ukazov v register
                HW_write = (  (strct -> start) |
                                     ((strct -> reset) << 1) |
                                         ((strct -> threshold) << 8) |
                                         ((strct -> acq_window) << 19) |
                                         ((strct -> sw_trigger) << 27)
                                   );
                //*reg_addr = HW_write;
                write_value(reg_addr, HW_write);
                //printf("VPIS v HW:0x%08x\n",HW_write);
                return 1; //sistem nastavljen
        }

        //branje histograma iz registra in shranjevanje podatkov v strukturo
        else if ( (strct -> send_data_flag) == 1)
        {
                HW_read = read_value(reg_addr);

                (strct -> UC_rd_en_current) = (HW_read & UC_rd_en_current_mask) >> 1;
                (strct -> UC_rd_en_final) = (HW_read & UC_rd_en_final_mask);
                (strct -> hist_data) = (HW_read & HIST_MASK) >> 8 ;


                //printf("PREBRANI PODATKI:0x%08x\n",HW_read);
                //printf("UC_rd_en_current: 0x%08x\n ",strct ->UC_rd_en_current);



                return 2; //podatki pripravljeni za posiljanje v PC
        }

        else
                return 0;

}






                /*

                //------------TRENUTNI HISTOGRAM-----------
                for (int idx=0; idx<BIN_NUM; idx++)
                {

                        HW_read = read_value(reg_addr);

                        (strct -> UC_rd_en_current) = HW_read & UC_rd_en_current_mask;
                        (strct -> UC_rd_en_final) = HW_read & UC_rd_en_final_mask;


                        if ( (HW_read & UC_rd_en_final_mask) == UC_rd_en_final_mask ) //prisel je koncni histogram, ne vpisuj vec v trenutnega
                        {
                                break;
                        }
                        else
                        {
                                //(strct -> hist_idx) = idx;
                                (strct -> hist_data+idx) = HW_read & HIST_MASK;
                        }


                        if(idx == BIN_NUM -1)
                        {
                                return 1;
                        }
                }


                //------------------KONCNI HISTOGRAM----------------
                if ( (strct -> UC_rd_en_final) == 1 && (strct -> UC_rd_en_current) == 0 )
                {
                        (strct -> hist_data + 0) = HW_read & HIST_MASK; //vpis prvega podatka koncnega histograma

                        for (int idx=1; idx<BIN_NUM; idx++)
                        {
                                HW_read = read_value(reg_addr);

                                (strct -> UC_rd_en_current) = HW_read & UC_rd_en_current_mask;
                                (strct -> UC_rd_en_final) = HW_read & UC_rd_en_final_mask;
                                //(strct -> hist_idx) = idx;
                                (strct -> hist_data+idx) = HW_read & HIST_MASK;
                        }


                        if(idx == BIN_NUM -1)
                        {
                                return 1;
                        }

                }
                */


//      }

//}