00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018 import RTC
00019 import OpenRTM
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040 class RingBuffer(OpenRTM.BufferBase):
00041 """
00042 """
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00060
00061 def __init__(self, length):
00062 self._oldPtr = 0
00063 if length < 2:
00064 self._length = 2
00065 self._newPtr = 1
00066 else:
00067 self._length = length
00068 self._newPtr = length - 1
00069
00070 self._inited = False
00071 self._buffer = [self.Data() for i in range(self._length)]
00072
00073
00074
00075
00076
00077
00078
00079
00080
00081
00082
00083
00084
00085
00086
00087
00088 def init(self, data):
00089 for i in range(self._length):
00090 self.put(data)
00091
00092
00093
00094
00095
00096
00097
00098
00099
00100
00101
00102
00103
00104
00105 def clear(self):
00106 self._inited = False
00107
00108
00109
00110
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125 def length(self):
00126 return self._length
00127
00128
00129
00130
00131
00132
00133
00134
00135
00136
00137
00138
00139
00140
00141
00142
00143
00144
00145
00146 def write(self, value):
00147 self.put(value)
00148 return True
00149
00150
00151
00152
00153
00154
00155
00156
00157
00158
00159
00160
00161
00162
00163
00164
00165
00166
00167
00168 def read(self, value):
00169 if not self._inited:
00170 return False
00171 value[0] = self.get()
00172 return True
00173
00174
00175
00176
00177
00178
00179
00180
00181
00182
00183
00184
00185
00186
00187
00188
00189
00190
00191 def isFull(self):
00192 return False
00193
00194
00195
00196
00197
00198
00199
00200
00201
00202
00203
00204
00205
00206
00207
00208
00209
00210
00211
00212
00213
00214 def isEmpty(self):
00215 return not self._inited
00216
00217
00218
00219
00220
00221
00222
00223
00224
00225
00226
00227
00228
00229
00230
00231
00232
00233
00234 def isNew(self):
00235 return self._buffer[self._newPtr].isNew()
00236
00237
00238
00239
00240
00241
00242
00243
00244
00245
00246
00247
00248
00249
00250
00251
00252
00253
00254
00255
00256
00257 def put(self, data):
00258 self._buffer[self._oldPtr].write(data)
00259 self._newPtr = self._oldPtr
00260 ptr = self._oldPtr + 1
00261 self._oldPtr = ptr % self._length
00262 self._inited = True
00263
00264
00265
00266
00267
00268
00269
00270
00271
00272
00273
00274
00275
00276
00277
00278
00279
00280
00281 def get(self):
00282 return self._buffer[self._newPtr].read()
00283
00284
00285
00286
00287
00288
00289
00290
00291
00292
00293
00294
00295
00296
00297
00298
00299
00300
00301 def getRef(self):
00302 return self._buffer[self._newPtr].data
00303
00304
00305
00306
00307
00308
00309
00310
00311
00312
00313
00314
00315
00316
00317 class Data:
00318 def __init__(self):
00319 self.data = None
00320 self.is_new = False
00321
00322
00323 def write(self, other):
00324 self.is_new = True
00325 self.data = other
00326
00327
00328 def read(self):
00329 self.is_new = False
00330 return self.data
00331
00332
00333 def isNew(self):
00334 return self.is_new