| [298] | 1 | /////////////////////////////////////////////////////////////////////////////////// | 
|---|
|  | 2 | // File      : cma_driver.c | 
|---|
|  | 3 | // Date      : 01/03/2014 | 
|---|
|  | 4 | // Author    : alain greiner | 
|---|
|  | 5 | // Copyright (c) UPMC-LIP6 | 
|---|
|  | 6 | /////////////////////////////////////////////////////////////////////////////////// | 
|---|
|  | 7 |  | 
|---|
|  | 8 | #include <cma_driver.h> | 
|---|
| [320] | 9 | #include <hard_config.h> | 
|---|
|  | 10 | #include <utils.h> | 
|---|
| [298] | 11 |  | 
|---|
| [320] | 12 | #if !defined(SEG_CMA_BASE) | 
|---|
|  | 13 | # error: You must define SEG_CMA_BASE in the hard_config.h file | 
|---|
|  | 14 | #endif | 
|---|
|  | 15 |  | 
|---|
| [437] | 16 | ///////////////////////////////////////////////////// | 
|---|
| [298] | 17 | unsigned int _cma_get_register( unsigned int channel, | 
|---|
|  | 18 | unsigned int index ) | 
|---|
|  | 19 | { | 
|---|
| [320] | 20 | unsigned int* vaddr = (unsigned int*)SEG_CMA_BASE + | 
|---|
| [298] | 21 | CHBUF_CHANNEL_SPAN*channel + index; | 
|---|
|  | 22 | return _io_extended_read( vaddr ); | 
|---|
|  | 23 | } | 
|---|
|  | 24 |  | 
|---|
| [437] | 25 | ///////////////////////////////////////////// | 
|---|
| [298] | 26 | void _cma_set_register( unsigned int channel, | 
|---|
|  | 27 | unsigned int index, | 
|---|
|  | 28 | unsigned int value ) | 
|---|
|  | 29 | { | 
|---|
| [320] | 30 | unsigned int* vaddr = (unsigned int*)SEG_CMA_BASE + | 
|---|
| [298] | 31 | CHBUF_CHANNEL_SPAN*channel + index; | 
|---|
|  | 32 | _io_extended_write( vaddr, value ); | 
|---|
|  | 33 | } | 
|---|
|  | 34 |  | 
|---|
| [437] | 35 | //////////////////////////////////////////////////// | 
|---|
|  | 36 | void _cma_start_channel( unsigned int       channel, | 
|---|
|  | 37 | unsigned long long src_paddr, | 
|---|
|  | 38 | unsigned int       src_nbufs, | 
|---|
|  | 39 | unsigned long long dst_paddr, | 
|---|
|  | 40 | unsigned int       dst_nbufs, | 
|---|
|  | 41 | unsigned int       buf_length ) | 
|---|
|  | 42 | { | 
|---|
|  | 43 | _cma_set_register( channel, CHBUF_SRC_DESC , (unsigned int)(src_paddr & 0xFFFFFFFF) ); | 
|---|
|  | 44 | _cma_set_register( channel, CHBUF_SRC_EXT  , (unsigned int)(src_paddr >> 32) ); | 
|---|
|  | 45 | _cma_set_register( channel, CHBUF_SRC_NBUFS, src_nbufs ); | 
|---|
|  | 46 | _cma_set_register( channel, CHBUF_DST_DESC , (unsigned int)(dst_paddr & 0xFFFFFFFF) ); | 
|---|
|  | 47 | _cma_set_register( channel, CHBUF_DST_EXT  , (unsigned int)(dst_paddr >> 32) ); | 
|---|
|  | 48 | _cma_set_register( channel, CHBUF_DST_NBUFS, dst_nbufs ); | 
|---|
|  | 49 | _cma_set_register( channel, CHBUF_BUF_SIZE , buf_length ); | 
|---|
|  | 50 | _cma_set_register( channel, CHBUF_PERIOD   , 300 ); | 
|---|
|  | 51 | _cma_set_register( channel, CHBUF_RUN      , 1 ); | 
|---|
|  | 52 | } | 
|---|
|  | 53 |  | 
|---|
|  | 54 | ////////////////////////////////////////////// | 
|---|
|  | 55 | void _cma_stop_channel( unsigned int channel ) | 
|---|
|  | 56 | { | 
|---|
|  | 57 | _cma_set_register( channel, CHBUF_RUN      , 0 ); | 
|---|
|  | 58 | } | 
|---|
|  | 59 |  | 
|---|
|  | 60 | ////////////////////////////////////// | 
|---|
| [298] | 61 | void _cma_isr( unsigned int irq_type, | 
|---|
|  | 62 | unsigned int irq_id, | 
|---|
|  | 63 | unsigned int channel ) | 
|---|
|  | 64 | { | 
|---|
| [437] | 65 | _puts("\n[GIET ERROR] _cma_isr() not implemented\n"); | 
|---|
| [298] | 66 | _exit(); | 
|---|
|  | 67 | } | 
|---|
|  | 68 |  | 
|---|
|  | 69 | // Local Variables: | 
|---|
|  | 70 | // tab-width: 4 | 
|---|
|  | 71 | // c-basic-offset: 4 | 
|---|
|  | 72 | // c-file-offsets:((innamespace . 0)(inline-open . 0)) | 
|---|
|  | 73 | // indent-tabs-mode: nil | 
|---|
|  | 74 | // End: | 
|---|
|  | 75 | // vim: filetype=c:expandtab:shiftwidth=4:tabstop=4:softtabstop=4 | 
|---|
|  | 76 |  | 
|---|