IMM imm = new IMM();
imm.initializePosition(initPoint.getX(),initPoint.getY());//初始化IMM
for(;;)
{
imm.run(1);//运行
Matrix temp = imm.getCurrentState();//获得当前帧预测位置
double pointDoubleX = Double.parseDouble(temp.getElementValue(0,0).toString());
double pointDoubleY = Double.parseDouble(temp.getElementValue(3,0).toString());
Point p = upData(pointDoubleX,pointDoubleY);//根据预测到得位置确定当前帧对象位置
imm.setObjectState(p.getX(),p.getY());//更新IMM模型
}
评论1