summaryrefslogtreecommitdiff
path: root/common/ipmbox/src/queue.c
blob: 5d899db24c558d2aacac65130268ba802a5a9461 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
/* Cesar project {{{
 *
 * Copyright (C) 2011 Spidcom
 *
 * <<<Licence>>>
 *
 * }}} */
/**
 * \file    common/ipmbox/src/queue.c
 * \brief   IPMbox queue management
 */
#include "common/universe.h"

#include "common/ipmbox/queue.h"

void
ipmbox_queue_copy_to (ipmbox_queue_t *queue, u32 *data,
                      unsigned int size)
{
    u32 *end, *tail;

    /* Check parameters. */
    dbg_claim (queue);
    dbg_claim (data);
    dbg_claim (size && size < queue->size);

    /* Initialize local pointers. */
    end = queue->end_ptr;
    tail = ipmbox_queue_phys_to_virt (queue, queue->ptr->tail);

    /* Copy each data. */
    while (size--)
    {
        /* Copy data. */
        *tail++ = *data++;
        /* If we reach end of queue, rollover. */
        if (tail == end)
            tail = queue->base_ptr;
    }

    /* Update tail pointer. */
    arch_reorder_barrier ();
    queue->ptr->tail = ipmbox_queue_virt_to_phys (queue, tail);
}

void
ipmbox_queue_copy_from (ipmbox_queue_t *queue, u32 *data,
                        unsigned int size)
{
    u32 *end, *head;

    /* Check parameters. */
    dbg_claim (queue);
    dbg_claim (data);
    dbg_claim (size && size < queue->size);

    /* Initialize local queue pointer. */
    head = ipmbox_queue_phys_to_virt (queue, queue->ptr->head);
    end = queue->end_ptr;

    /* Get data. */
    while (size--)
    {
        /* Get data. */
        *data++ = *head++;
        /* If we reach end of queue, rollover. */
        if (head == end)
            head = queue->base_ptr;
    }

    /* Update head pointer. */
    arch_reorder_barrier ();
    queue->ptr->head = ipmbox_queue_virt_to_phys (queue, head);
}