TPCircularBuffer.c 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123
  1. // original source from Michael Tyson
  2. //
  3. // modified by adding additional functions to produce and consume without checking for buffer underflow
  4. // for delay lines
  5. // tz 11/2011
  6. //
  7. // TPCircularBuffer.c
  8. // Circular buffer implementation
  9. //
  10. // Created by Michael Tyson on 20/03/2011.
  11. // Copyright 2011 A Tasty Pixel. All rights reserved.
  12. //
  13. #include "TPCircularBuffer.h"
  14. #include <string.h>
  15. static inline int min(int a, int b) {
  16. return (a>b ? b : a);
  17. }
  18. inline void TPCircularBufferInit(TPCircularBufferRecord *record, int length) {
  19. record->head = record->tail = record->fillCount = 0;
  20. record->length = length;
  21. }
  22. inline int TPCircularBufferFillCount(TPCircularBufferRecord *record) {
  23. return record->fillCount;
  24. }
  25. inline int TPCircularBufferFillCountContiguous(TPCircularBufferRecord *record) {
  26. return min(record->fillCount, record->length-record->tail);
  27. }
  28. inline int TPCircularBufferSpace(TPCircularBufferRecord *record) {
  29. return record->length - record->fillCount;
  30. }
  31. inline int TPCircularBufferSpaceContiguous(TPCircularBufferRecord *record) {
  32. return min(record->length-record->fillCount, record->length-record->head);
  33. }
  34. inline int TPCircularBufferHead(TPCircularBufferRecord *record) {
  35. return record->head;
  36. }
  37. inline int TPCircularBufferTail(TPCircularBufferRecord *record) {
  38. return record->tail;
  39. }
  40. inline void TPCircularBufferProduce(TPCircularBufferRecord *record, int amount) {
  41. record->head = (record->head + amount) % record->length;
  42. OSAtomicAdd32Barrier(amount, &record->fillCount);
  43. }
  44. inline void TPCircularBufferProduceSingleThread(TPCircularBufferRecord *record, int amount) {
  45. record->head = (record->head + amount) % record->length;
  46. record->fillCount += amount;
  47. }
  48. inline int TPCircularBufferProduceBytes(TPCircularBufferRecord *record, void* dst, const void* src, int count, int len) {
  49. int copied = 0;
  50. while ( count > 0 ) {
  51. int space = TPCircularBufferSpaceContiguous(record);
  52. if ( space == 0 ) {
  53. return copied;
  54. }
  55. int toCopy = min(count, space);
  56. int bytesToCopy = toCopy * len;
  57. memcpy(dst + (len*TPCircularBufferHead(record)), src, bytesToCopy);
  58. src += bytesToCopy;
  59. count -= toCopy;
  60. copied += bytesToCopy/len;
  61. TPCircularBufferProduce(record, toCopy);
  62. }
  63. return copied;
  64. }
  65. inline void TPCircularBufferConsume(TPCircularBufferRecord *record, int amount) {
  66. record->tail = (record->tail + amount) % record->length;
  67. OSAtomicAdd32Barrier(-amount, &record->fillCount);
  68. }
  69. inline void TPCircularBufferConsumeSingleThread(TPCircularBufferRecord *record, int amount) {
  70. record->tail = (record->tail + amount) % record->length;
  71. record->fillCount -= amount;
  72. }
  73. inline void TPCircularBufferClear(TPCircularBufferRecord *record) {
  74. record->tail = record->head;
  75. record->fillCount = 0;
  76. }
  77. // tz addition to allow resetting the tail
  78. inline void TPCircularBufferSetTail(TPCircularBufferRecord *record, int32_t position, int32_t count) {
  79. record->tail = position;
  80. record->fillCount = count;
  81. }
  82. // tz - return buffer length
  83. inline int TPCircularBufferLength(TPCircularBufferRecord *record) {
  84. return record->length;
  85. }
  86. inline void TPCircularBufferProduceAnywhere(TPCircularBufferRecord *record, int amount) {
  87. record->head = (record->head + amount) % record->length;
  88. // record->fillCount += amount;
  89. }
  90. inline void TPCircularBufferConsumeAnywhere(TPCircularBufferRecord *record, int amount) {
  91. record->tail = (record->tail + amount) % record->length;
  92. // record->fillCount -= amount;
  93. }
  94. inline void TPCircularBufferSetTailAnywhere(TPCircularBufferRecord *record, int32_t position) {
  95. record->tail = position;
  96. // record->fillCount = count;
  97. }