adding EE cog compensation to id controller