def executeAlgorithm(self): self.predictedData = [] for index, sample in enumerate(self.inputData): if sample.time < self.predictionInterval: # Set initial values predictionSample = PredictionSample() predictionSample.sample = copy(sample) predictionSample.velocity = Vector() self.predictedData.append(predictionSample) else: shift = index - self.predictionInterval / self.samplingInterval # Calculate velocity deltaPosition = self.inputData[index].position - \ self.inputData[shift].position deltaTime = self.inputData[index].time - \ self.inputData[shift].time invDeltaTimeVector = Vector( 1 / float(deltaTime), \ 1 / float(deltaTime), \ 1 / float(deltaTime)) velocity = deltaPosition * invDeltaTimeVector # Populate data structures predictionSample = PredictionSample() predictionSample.sample = copy(sample) predictionSample.velocity = velocity self.predictedData.append(predictionSample)
def executeAlgorithm(self): self.predictedData = [] for index, sample in enumerate(self.inputData): if sample.time < self.predictionInterval: # Set initial values predictionSample = PredictionSample() predictionSample.sample = copy(sample) predictionSample.velocity = Vector() self.predictedData.append( predictionSample ) else: shift = index - self.predictionInterval / self.samplingInterval # Calculate velocity deltaPosition = self.inputData[index].position - \ self.inputData[shift].position deltaTime = self.inputData[index].time - \ self.inputData[shift].time invDeltaTimeVector = Vector( 1 / float(deltaTime), \ 1 / float(deltaTime), \ 1 / float(deltaTime)) velocity = deltaPosition * invDeltaTimeVector # Populate data structures predictionSample = PredictionSample() predictionSample.sample = copy(sample) predictionSample.velocity = velocity self.predictedData.append( predictionSample )
def calcExtrapolationSample(self, currentSample, targetSample): deltaPosition = targetSample.position - currentSample.position deltaTime = targetSample.time - currentSample.time invDeltaTimeVector = Vector(1 / float(deltaTime), 1 / float(deltaTime), 1 / float(deltaTime)) velocity = deltaPosition * invDeltaTimeVector extrapolationSample = PredictionSample() extrapolationSample.sample = deepcopy(currentSample) extrapolationSample.velocity = velocity return extrapolationSample
def calcExtrapolationSample(self, snapSample, targetSample): deltaPosition = targetSample.position - snapSample.position deltaTime = targetSample.time - snapSample.time invDeltaTimeVector = Vector( 1 / float(deltaTime), \ 1 / float(deltaTime), \ 1 / float(deltaTime)) velocity = deltaPosition * invDeltaTimeVector extrapolationSample = PredictionSample() extrapolationSample.sample = deepcopy(snapSample) extrapolationSample.velocity = velocity return extrapolationSample
def findInterpolationSample(self, currentSample, targetSample): deltaPosition = targetSample.sample.position - \ currentSample.sample.position deltaTime = targetSample.sample.time - \ currentSample.sample.time invDeltaTimeVector = Vector( 1 / float(deltaTime), \ 1 / float(deltaTime), \ 1 / float(deltaTime)) velocity = deltaPosition * invDeltaTimeVector interpolationSample = PredictionSample() interpolationSample.sample = deepcopy(currentSample.sample) interpolationSample.velocity = velocity return interpolationSample
def findInterpolationSample(self, currentSample, targetSample): deltaPosition = targetSample.position - \ currentSample.position deltaTime = targetSample.time - \ currentSample.time invDeltaTimeVector = Vector( 1 / float(deltaTime), \ 1 / float(deltaTime), \ 1 / float(deltaTime)) velocity = deltaPosition * invDeltaTimeVector interpolationSample = PredictionSample() interpolationSample.sample = deepcopy(currentSample) interpolationSample.velocity = velocity return interpolationSample
def executeAlgorithm(self): self.reconstructedSignal = [] nextTimeToRecord = 0 timeDiff = self.rawSignal[0].sample.time % self.samplingInterval if timeDiff == 0: self.reconstructedSignal.append( deepcopy(self.rawSignal[0].sample) ) nextTimeToRecord = self.rawSignal[0].sample.time + \ self.samplingInterval else: change = self.samplingInterval - timeDiff newSample = Sample() newSample.time = self.rawSignal[0].sample.time + change newSample.position = deepcopy(self.rawSignal[0].sample.position) self.reconstructedSignal.append(newSample) nextTimeToRecord = newSample.time + self.samplingInterval interpolationSample = PredictionSample() interpolationSample.sample = self.reconstructedSignal[0] interpolationSample.velocity = self.rawSignal[0].velocity for index, predictionSample in enumerate(self.rawSignal): if predictionSample.sample.time == nextTimeToRecord: estimatedSample = self.calculateEstSample(interpolationSample, \ nextTimeToRecord) self.reconstructedSignal.append(estimatedSample) targetSample = self.findTarget(predictionSample) interpolationSample = self.findInterpolationSample(estimatedSample, \ targetSample) nextTimeToRecord = nextTimeToRecord + self.samplingInterval elif predictionSample.sample.time > nextTimeToRecord: while predictionSample.sample.time > nextTimeToRecord: estimatedSample = self.calculateEstSample(interpolationSample, \ nextTimeToRecord) self.reconstructedSignal.append(estimatedSample) nextTimeToRecord = nextTimeToRecord + self.samplingInterval if predictionSample.sample.time == nextTimeToRecord: estimatedSample = self.calculateEstSample(interpolationSample, \ nextTimeToRecord) self.reconstructedSignal.append(estimatedSample) targetSample = self.findTarget(predictionSample) interpolationSample = self.findInterpolationSample(estimatedSample, \ targetSample) nextTimeToRecord = nextTimeToRecord + self.samplingInterval else: targetSample = self.findTarget(predictionSample) interpolationSample = self.findInterpolationSample(self.reconstructedSignal[-1], \ targetSample)
def findSnapSample(self, currentSample, estimatedSample, targetSample): deltaPosition = targetSample.sample.position - \ currentSample.sample.position deltaPosition.x *= self.snapLimit deltaPosition.y *= self.snapLimit deltaPosition.z *= self.snapLimit snapPosition = currentSample.sample.position + deltaPosition deltaPosition = targetSample.sample.position - snapPosition deltaTime = targetSample.sample.time - \ currentSample.sample.time invDeltaTimeVector = Vector( 1 / float(deltaTime), \ 1 / float(deltaTime), \ 1 / float(deltaTime)) velocity = deltaPosition * invDeltaTimeVector snapSample = PredictionSample() snapSample.sample = Sample(currentSample.sample.time, snapPosition) snapSample.velocity = velocity return snapSample
def findSnapSample(self, currentSample, estimatedSample, targetSample): deltaPosition = targetSample.sample.position - \ currentSample.sample.position deltaPosition.x *= self.snapLimit deltaPosition.y *= self.snapLimit deltaPosition.z *= self.snapLimit snapPosition = currentSample.sample.position + deltaPosition deltaPosition = targetSample.sample.position - snapPosition deltaTime = targetSample.sample.time - \ currentSample.sample.time invDeltaTimeVector = Vector( 1 / float(deltaTime), \ 1 / float(deltaTime), \ 1 / float(deltaTime)) velocity = deltaPosition * invDeltaTimeVector snapSample = PredictionSample() snapSample.sample = Sample(currentSample.sample.time, snapPosition) snapSample.velocity = velocity return snapSample