Changed the way object tracker updates motion model. Seems to work ok
Sorted bug in object bundle, need to clean up code now