| 28 | } |
| 29 | |
| 30 | void Enqueue(T* data){ |
| 31 | acquireLock(&dequeueLock); |
| 32 | acquireLock(&enqueueLock); |
| 33 | |
| 34 | memcpy(enqueuePointer++, data, sizeof(T)); |
| 35 | |
| 36 | if(enqueuePointer >= bufferEnd){ |
| 37 | enqueuePointer = buffer; |
| 38 | } |
| 39 | |
| 40 | if(enqueuePointer == dequeuePointer){ |
| 41 | |
| 42 | T* oldBuffer = buffer; |
| 43 | T* oldBufferEnd = bufferEnd; |
| 44 | |
| 45 | bufferSize = (bufferSize + 2) << 1; |
| 46 | |
| 47 | buffer = reinterpret_cast<T*>(kmalloc(sizeof(T) * bufferSize)); |
| 48 | bufferEnd = &buffer[bufferSize - 1]; |
| 49 | |
| 50 | memcpy(bufferEnd - (oldBufferEnd - dequeuePointer), dequeuePointer, oldBufferEnd - dequeuePointer); |
| 51 | |
| 52 | dequeuePointer = bufferEnd - (oldBufferEnd - dequeuePointer); |
| 53 | enqueuePointer = buffer + (enqueuePointer - oldBuffer); |
| 54 | |
| 55 | kfree(oldBuffer); |
| 56 | } |
| 57 | releaseLock(&enqueueLock); |
| 58 | releaseLock(&dequeueLock); |
| 59 | } |
| 60 | |
| 61 | int Dequeue(T* data, size_t amount){ |
| 62 | acquireLock(&dequeueLock); |