X-Git-Url: http://git.rot13.org/?a=blobdiff_plain;f=src%2Frfid_layer2.c;h=4cad6c3ab3029fbe265a5793487e05fc8222defe;hb=507a87a79b9893c1ac400a59c4d49ab63bbf84be;hp=eef05604ecb2ca93b5bdd95cc1b6d04a8172aad6;hpb=2e5b78aa3beb31e5d9d83e693c59671faebfc932;p=librfid

diff --git a/src/rfid_layer2.c b/src/rfid_layer2.c
index eef0560..4cad6c3 100644
--- a/src/rfid_layer2.c
+++ b/src/rfid_layer2.c
@@ -1,5 +1,5 @@
 /* librfid - layer 2 protocol handler 
- * (C) 2005 by Harald Welte <laforge@gnumonks.org>
+ * (C) 2005-2006 by Harald Welte <laforge@gnumonks.org>
  */
 
 /*
@@ -14,29 +14,35 @@
  *
  *  You should have received a copy of the GNU General Public License
  *  along with this program; if not, write to the Free Software
- *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
  */
 
 #include <stdlib.h>
 #include <stdio.h>
 #include <errno.h>
+#include <string.h> /* for memcpy */
 
 #include <librfid/rfid.h>
 #include <librfid/rfid_layer2.h>
 
-static struct rfid_layer2 *rfid_layer2_list;
+static const struct rfid_layer2 *rfid_layer2s[] = {
+	[RFID_LAYER2_ISO14443A]	= &rfid_layer2_iso14443a,
+	[RFID_LAYER2_ISO14443B]	= &rfid_layer2_iso14443b,
+	[RFID_LAYER2_ISO15693]	= &rfid_layer2_iso15693,
+};
 
 struct rfid_layer2_handle *
 rfid_layer2_init(struct rfid_reader_handle *rh, unsigned int id)
 {
 	struct rfid_layer2 *p;
 
-	for (p = rfid_layer2_list; p; p = p->next)
-		if (p->id == id)
-			return p->fn.init(rh);
+	if (id >= ARRAY_SIZE(rfid_layer2s)) {
+		DEBUGP("unable to find matching layer2 protocol\n");
+		return NULL;
+	}
 
-	DEBUGP("unable to find matching layer2 protocol\n");
-	return NULL;
+	p = rfid_layer2s[id];
+	return p->fn.init(rh);
 }
 
 int
@@ -79,31 +85,61 @@ rfid_layer2_close(struct rfid_layer2_handle *ph)
 	return ph->l2->fn.close(ph);
 }
 
-int
-rfid_layer2_register(struct rfid_layer2 *p)
-{
-	p->next = rfid_layer2_list;
-	rfid_layer2_list = p;
-
-	return 0;
-}
-
 int
 rfid_layer2_getopt(struct rfid_layer2_handle *ph, int optname,
 		   void *optval, unsigned int *optlen)
 {
-	if (!ph->l2->fn.getopt)
-		return -EINVAL;
-
-	return ph->l2->fn.getopt(ph, optname, optval, optlen);
+	if (optname >> 16 == 0) {
+		unsigned char *optchar = optval;
+
+		switch (optname) {
+		case RFID_OPT_LAYER2_UID:
+			if (ph->uid_len < *optlen)
+				*optlen = ph->uid_len;
+			memcpy(optchar, ph->uid, *optlen);
+			break;
+		default:
+			return -EINVAL;
+			break;
+		}
+	} else {
+		if (!ph->l2->fn.getopt)
+			return -EINVAL;
+
+		return ph->l2->fn.getopt(ph, optname, optval, optlen);
+	}
+	return 0;
 }
 
 int
 rfid_layer2_setopt(struct rfid_layer2_handle *ph, int optname,
 		   const void *optval, unsigned int optlen)
 {
-	if (!ph->l2->fn.setopt)
-		return -EINVAL;
+	if (optname >> 16 == 0) {
+		switch (optname) {
+		case RFID_OPT_LAYER2_UID:
+		printf("----> sizeof(ph->uid): %d\n",sizeof(ph->uid));
+			if ((ph->uid_len < sizeof(ph->uid)) && (optlen<=sizeof(ph->uid))) {
+				//(ph->uid_len<optlen)
+				ph->uid_len = optlen;
+				memcpy(ph->uid, optval, optlen);
+			} else
+				return -EINVAL;
+		break;
+		default:
+			return -EINVAL;
+			break;
+		}
+	} else {
+		if (!ph->l2->fn.setopt)
+			return -EINVAL;
+
+		return ph->l2->fn.setopt(ph, optname, optval, optlen);
+	}
+	return 0;
+}
 
-	return ph->l2->fn.setopt(ph, optname, optval, optlen);
+char *rfid_layer2_name(struct rfid_layer2_handle *l2h)
+{
+	return l2h->l2->name;
 }