1. Modified ArucoObservationmodel. In computeinnovation now, we compute innovation
using the closes matching landmark as there are multiple landmarks wtih same IDs.

2. additional bug fixes.