System.out.println("Range: " + (int) range);
measurement.set(0,0, (double) range);
// Update the state
try {
filter.update(control, measurement);
} catch(Exception e) {
System.out.println("Exception: " + e.getClass()+ ":" + e.getMessage());
}
// Print the results