Added a SD_IMAGE_NOISE constant in EKF.java
Removed the useless size variable.
Created a CovarianceMatrix class and used this in EKF.