diff --git a/src/cpm.c b/src/cpm.c index 7739b89..77a09ba 100644 --- a/src/cpm.c +++ b/src/cpm.c @@ -421,17 +421,17 @@ void mk_cpm(facilities_t* facilities,CPM_t* cpm_tx, struct timespec* systemtime) cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->objectConfidence = 95; cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->xDistance.value = rotate_x( - (long)as_objects[i].f_xPoint, (long)as_objects[i].f_yPoint); + (long)as_objects[i].f_xPoint * 100, (long)as_objects[i].f_yPoint * 100); cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->xDistance.confidence = 102; // printf("->%f<-\n", as_objects[i].f_xPoint); cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->yDistance.value = rotate_y( - (long)as_objects[i].f_xPoint, (long)as_objects[i].f_yPoint); + (long)as_objects[i].f_xPoint * 100, (long)as_objects[i].f_yPoint * 100); cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->yDistance.confidence = 102; cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->xSpeed.value = rotate_x( - (long)as_objects[i].f_xSpeed, (long)as_objects[i].f_ySpeed); + (long)as_objects[i].f_xSpeed * 100, (long)as_objects[i].f_ySpeed * 100); cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->xSpeed.confidence = 40; cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->ySpeed.value = rotate_y( - (long)as_objects[i].f_xSpeed, (long)as_objects[i].f_ySpeed); + (long)as_objects[i].f_xSpeed * 100, (long)as_objects[i].f_ySpeed * 100); cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->ySpeed.confidence = 40; cpm_tx->cpm.cpmParameters.perceivedObjectContainer->list.array[i]->objectRefPoint = ObjectRefPoint_bottomMid; }