KFMastercomponent.emadl 1.54 KB
Newer Older
1 2 3 4 5 6
package dp.subcomponents;

component KFMastercomponent {
    ports in Affordance predictions,
          out Affordance predictionsSmoothed;

Svetlana's avatar
Draft  
Svetlana committed
7 8 9 10 11 12
    instance Kalmanfilter kfLL;
    //instance Kalmanfilter([predictions.distLL, 0]) kfLL;
    //instance Kalmanfilter([predictions.distMM, 0]) kfMM;
    //instance Kalmanfilter([predictions.distRR, 0]) kfRR;
    //instance Kalmanfilter([predictions.distL, 0]) kfL;
    //instance Kalmanfilter([predictions.distR, 0]) kfR;
13

Svetlana's avatar
Draft  
Svetlana committed
14 15 16 17 18 19 20 21
    //connect predictions.angle -> predictionsSmoothed.angle;
    //connect predictions.toMarkingLL -> predictionsSmoothed.toMarkingLL;
    //connect predictions.toMarkingML -> predictionsSmoothed.toMarkingML;
    //connect predictions.toMarkingMR -> predictionsSmoothed.toMarkingMR;
    //connect predictions.toMarkingRR -> predictionsSmoothed.toMarkingRR;
    //connect predictions.toMarkingL -> predictionsSmoothed.toMarkingL;
    //connect predictions.toMarkingM -> predictionsSmoothed.toMarkingM;
    //connect predictions.toMarkingR -> predictionsSmoothed.toMarkingR;
22

Svetlana's avatar
Draft  
Svetlana committed
23 24 25 26 27
    //connect predictions.distLL -> kfLL.measurement;
    //connect predictions.distMM -> kfMM.measurement;
    //connect predictions.distRR -> kfRR.measurement;
    //connect predictions.distL -> kfL.measurement;
    //connect predictions.distR -> kfR.measurement;
28

Svetlana's avatar
Draft  
Svetlana committed
29 30 31 32 33
    //connect kfLL.state-> predictionsSmoothed.distLL;
    //connect kfMM.state-> predictionsSmoothed.distMM;
    //connect kfRR.state-> predictionsSmoothed.distRR;
    //connect kfL.state-> predictionsSmoothed.distL;
    //connect kfR.state-> predictionsSmoothed.distR;
34
}