Check cap before enrolling.

1 files changed, 8 insertions, 2 deletions

diff --git a/r503.c b/r503.c
index 3320a1c..6a10f10 100644
--- a/r503.c
+++ b/r503.c
@@ -263,11 +263,17 @@ uint16_t fpm_get_count(void)
 	return count;
 }
 
-uint8_t fpm_enroll(uint16_t id)
+uint8_t fpm_enroll(void)
 {
-	uint16_t n;
+	struct fpm_cfg cfg;
+	uint16_t n, id;
 	uint8_t buf[MAXPDLEN];
 
+	fpm_get_cfg(&cfg);
+	id = fpm_get_count();
+	if (n == cfg.cap)
+		return 0;
+
 	if (!scan())
 		return 0;