Added JPDAF, updated Kalman filtering, minor updates & bug fixing