1 /*
2 * Copyright (c) 2021 Huawei Device Co., Ltd.
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at
6 *
7 * http://www.apache.org/licenses/LICENSE-2.0
8 *
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
14 */
15
16 #ifndef HDF_USB_DATA_FIFO_H
17 #define HDF_USB_DATA_FIFO_H
18
19 #include "hdf_base.h"
20
21 #ifndef MIN
22 #define MIN(a, b) ((a) < (b) ? (a) : (b))
23 #endif
24
25 #ifndef MAX
26 #define MAX(a, b) ((a) > (b) ? (a) : (b))
27 #endif
28
29 struct DataFifo {
30 uint32_t rdIdx;
31 uint32_t wrIdx;
32 uint32_t size;
33 void *data;
34 };
35
36 /* DataFifo Helper function */
DataFifoInit(struct DataFifo * fifo,uint32_t size,void * data)37 static inline void DataFifoInit(struct DataFifo *fifo, uint32_t size, void *data)
38 {
39 fifo->rdIdx = 0;
40 fifo->wrIdx = 0;
41 fifo->size = size;
42 fifo->data = data;
43 }
44
DataFifoIsInitialized(struct DataFifo * fifo)45 static inline bool DataFifoIsInitialized(struct DataFifo *fifo)
46 {
47 return fifo->size != 0;
48 }
49
DataFifoReset(struct DataFifo * fifo)50 static inline void DataFifoReset(struct DataFifo *fifo)
51 {
52 fifo->rdIdx = fifo->wrIdx = 0;
53 }
54
DataFifoLen(struct DataFifo * fifo)55 static inline uint32_t DataFifoLen(struct DataFifo *fifo)
56 {
57 return fifo->wrIdx - fifo->rdIdx;
58 }
59
DataFifoIsEmpty(struct DataFifo * fifo)60 static inline bool DataFifoIsEmpty(struct DataFifo *fifo)
61 {
62 return fifo->wrIdx == fifo->rdIdx;
63 }
64
DataFifoIsFull(struct DataFifo * fifo)65 static inline bool DataFifoIsFull(struct DataFifo *fifo)
66 {
67 return DataFifoLen(fifo) > (fifo->size - 1);
68 }
69
DataFifoAvailSize(struct DataFifo * fifo)70 static inline uint32_t DataFifoAvailSize(struct DataFifo *fifo)
71 {
72 return fifo->size - DataFifoLen(fifo);
73 }
74
DataFifoSkip(struct DataFifo * fifo,uint32_t size)75 static inline void DataFifoSkip(struct DataFifo *fifo, uint32_t size)
76 {
77 fifo->rdIdx += size;
78 }
79
DataFifoWrite(struct DataFifo * fifo,uint8_t * data,uint32_t size)80 static inline uint32_t DataFifoWrite(struct DataFifo *fifo, uint8_t *data, uint32_t size)
81 {
82 uint32_t mask = fifo->size - 1;
83 uint8_t *buf = fifo->data;
84 uint8_t *end;
85
86 size = MIN(size, DataFifoAvailSize(fifo));
87 end = data + size;
88 while (data < end) {
89 buf[fifo->wrIdx++ & mask] = *data++;
90 }
91 return size;
92 }
93
DataFifoRead(struct DataFifo * fifo,uint8_t * data,uint32_t size)94 static inline uint32_t DataFifoRead(struct DataFifo *fifo, uint8_t *data, uint32_t size)
95 {
96 uint32_t mask = fifo->size - 1;
97 uint8_t *buf = fifo->data;
98 uint8_t *end;
99
100 size = MIN(size, DataFifoLen(fifo));
101 end = data + size;
102 while (data < end) {
103 *data++ = buf[fifo->rdIdx++ & mask];
104 }
105 return size;
106 }
107
108 #endif /* HDF_USB_DATA_FIFO_H */
109