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;

                        }

                }

                */

//      }

//}