Added GRP representtion in EKF