/* en50221 encoder An implementation for libdvb an implementation for the en50221 transport layer Copyright (C) 2004, 2005 Manu Abraham Copyright (C) 2005 Julian Scheel (julian at jusst dot de) Copyright (C) 2006 Andrew de Quincey (adq_dvb@lidskialf.net) This library is free software; you can redistribute it and/or modify it under the terms of the GNU Lesser General Public License as published by the Free Software Foundation; either version 2.1 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public License for more details. You should have received a copy of the GNU Lesser General Public License along with this library; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ #include #include #include #include "en50221_app_smartcard.h" #include "en50221_app_tags.h" #include "asn_1.h" struct en50221_app_smartcard { struct en50221_app_send_functions *funcs; en50221_app_smartcard_command_callback command_callback; void *command_callback_arg; en50221_app_smartcard_send_callback send_callback; void *send_callback_arg; pthread_mutex_t lock; }; static int en50221_app_smartcard_parse_command(struct en50221_app_smartcard *smartcard, uint8_t slot_id, uint16_t session_number, uint8_t * data, uint32_t data_length); static int en50221_app_smartcard_parse_send(struct en50221_app_smartcard *smartcard, uint8_t slot_id, uint16_t session_number, uint8_t * data, uint32_t data_length); struct en50221_app_smartcard *en50221_app_smartcard_create(struct en50221_app_send_functions *funcs) { struct en50221_app_smartcard *smartcard = NULL; // create structure and set it up smartcard = malloc(sizeof(struct en50221_app_smartcard)); if (smartcard == NULL) { return NULL; } smartcard->funcs = funcs; smartcard->command_callback = NULL; smartcard->send_callback = NULL; pthread_mutex_init(&smartcard->lock, NULL); // done return smartcard; } void en50221_app_smartcard_destroy(struct en50221_app_smartcard *smartcard) { pthread_mutex_destroy(&smartcard->lock); free(smartcard); } void en50221_app_smartcard_register_command_callback(struct en50221_app_smartcard *smartcard, en50221_app_smartcard_command_callback callback, void *arg) { pthread_mutex_lock(&smartcard->lock); smartcard->command_callback = callback; smartcard->command_callback_arg = arg; pthread_mutex_unlock(&smartcard->lock); } void en50221_app_smartcard_register_send_callback(struct en50221_app_smartcard *smartcard, en50221_app_smartcard_send_callback callback, void *arg) { pthread_mutex_lock(&smartcard->lock); smartcard->send_callback = callback; smartcard->send_callback_arg = arg; pthread_mutex_unlock(&smartcard->lock); } int en50221_app_smartcard_command_reply(struct en50221_app_smartcard *smartcard, uint16_t session_number, uint8_t reply_id, uint8_t status, uint8_t *data, uint32_t data_length) { uint8_t hdr[10]; struct iovec iovec[2]; int iov_count = 0; // the tag hdr[0] = (TAG_SMARTCARD_REPLY >> 16) & 0xFF; hdr[1] = (TAG_SMARTCARD_REPLY >> 8) & 0xFF; hdr[2] = TAG_SMARTCARD_REPLY & 0xFF; // the rest of the data if (reply_id == SMARTCARD_REPLY_ID_ANSW_TO_RESET) { // encode the length field int length_field_len; if ((length_field_len = asn_1_encode(data_length + 2, data + 3, 3)) < 0) { return -1; } // the rest of the header hdr[3 + length_field_len] = reply_id; hdr[3 + length_field_len + 1] = status; iovec[0].iov_base = hdr; iovec[0].iov_len = 3 + length_field_len + 2; // the data iovec[1].iov_base = data; iovec[1].iov_len = data_length; iov_count = 2; } else { hdr[3] = 2; hdr[4] = reply_id; hdr[5] = status; iovec[0].iov_base = data; iovec[0].iov_len = 6; iov_count = 1; } return smartcard->funcs->send_datav(smartcard->funcs->arg, session_number, iovec, iov_count); } int en50221_app_smartcard_receive(struct en50221_app_smartcard *smartcard, uint16_t session_number, uint8_t *data, uint32_t data_length, uint8_t SW1, uint8_t SW2) { uint8_t buf[10]; uint8_t trailer[10]; // set up the tag buf[0] = (TAG_SMARTCARD_RCV >> 16) & 0xFF; buf[1] = (TAG_SMARTCARD_RCV >> 8) & 0xFF; buf[2] = TAG_SMARTCARD_RCV & 0xFF; // encode the length field int length_field_len; if ((length_field_len = asn_1_encode(data_length + 2, buf + 3, 3)) < 0) { return -1; } // set up the trailer trailer[0] = SW1; trailer[1] = SW2; // build the iovecs struct iovec iov[3]; iov[0].iov_base = buf; iov[0].iov_len = 3 + length_field_len; iov[1].iov_base = data; iov[1].iov_len = data_length; iov[2].iov_base = trailer; iov[2].iov_len = 2; // create the data and send it return smartcard->funcs->send_datav(smartcard->funcs->arg, session_number, iov, 3); } int en50221_app_smartcard_message(struct en50221_app_smartcard *smartcard, uint8_t slot_id, uint16_t session_number, uint32_t resource_id, uint8_t *data, uint32_t data_length) { (void) resource_id; // get the tag if (data_length < 3) { print(LOG_LEVEL, ERROR, 1, "Received short data\n"); return -1; } uint32_t tag = (data[0] << 16) | (data[1] << 8) | data[2]; switch (tag) { case TAG_SMARTCARD_COMMAND: return en50221_app_smartcard_parse_command(smartcard, slot_id, session_number, data + 3, data_length - 3); case TAG_SMARTCARD_SEND: return en50221_app_smartcard_parse_send(smartcard, slot_id, session_number, data + 3, data_length - 3); } print(LOG_LEVEL, ERROR, 1, "Received unexpected tag %x\n", tag); return -1; } static int en50221_app_smartcard_parse_command(struct en50221_app_smartcard *smartcard, uint8_t slot_id, uint16_t session_number, uint8_t * data, uint32_t data_length) { if (data_length != 2) { print(LOG_LEVEL, ERROR, 1, "Received short data\n"); return -1; } if (data[0] != 1) { print(LOG_LEVEL, ERROR, 1, "Received short data\n"); return -1; } uint8_t command_id = data[1]; // tell the app pthread_mutex_lock(&smartcard->lock); en50221_app_smartcard_command_callback cb = smartcard->command_callback; void *cb_arg = smartcard->command_callback_arg; pthread_mutex_unlock(&smartcard->lock); if (cb) { return cb(cb_arg, slot_id, session_number, command_id); } return 0; } static int en50221_app_smartcard_parse_send(struct en50221_app_smartcard *smartcard, uint8_t slot_id, uint16_t session_number, uint8_t * data, uint32_t data_length) { // first of all, decode the length field uint16_t asn_data_length; int length_field_len; if ((length_field_len = asn_1_decode(&asn_data_length, data, data_length)) < 0) { print(LOG_LEVEL, ERROR, 1, "ASN.1 decode error\n"); return -1; } // check it if (asn_data_length < 8) { print(LOG_LEVEL, ERROR, 1, "Received short data\n"); return -1; } if (asn_data_length > (data_length - length_field_len)) { print(LOG_LEVEL, ERROR, 1, "Received short data\n"); return -1; } data += length_field_len; // parse uint8_t CLA = data[0]; uint8_t INS = data[1]; uint8_t P1 = data[2]; uint8_t P2 = data[3]; uint16_t length_in = (data[4] << 8) | data[5]; uint8_t *data_in = data + 6; // validate the length if ((length_in + 8) != asn_data_length) { print(LOG_LEVEL, ERROR, 1, "Received short data\n"); return -1; } uint16_t length_out = (data[6 + length_in] << 8) | data[6 + length_in + 1]; // tell the app pthread_mutex_lock(&smartcard->lock); en50221_app_smartcard_send_callback cb = smartcard->send_callback; void *cb_arg = smartcard->send_callback_arg; pthread_mutex_unlock(&smartcard->lock); if (cb) { return cb(cb_arg, slot_id, session_number, CLA, INS, P1, P2, data_in, length_in, length_out); } return 0; } ian/dtv-scan-tables.git/tag/?h=debian/0%2bgit20141009.d26b627-1'>debian/0+git20141009.d26b627-1Jonathan McCrohan1-2/+2 2014-10-20Fix up packaging to account for move to DVBv5Jonathan McCrohan2-2/+6 2014-10-20delete d/dtv-scan-files.install; Upstream now supplies a MakefileJonathan McCrohan2-4/+1 2014-10-15d/control: update Standards Version to 3.9.6Jonathan McCrohan2-1/+3 2014-10-15d/control: add Build-Depends on dvb-toolsJonathan McCrohan2-1/+2 2014-10-15New Upstream Snapshot (commit d26b627)Jonathan McCrohan1-0/+10 2014-10-15Imported Upstream version 0+git20141009.d26b627upstream/0+git20141009.d26b627Jonathan McCrohan2010-11120/+159271 2014-07-23Release 0+git20140611.14bd6c7-1debian/0+git20140611.14bd6c7-1Jonathan McCrohan1-2/+2 2014-07-23New Upstream Snapshot (commit 14bd6c7)Jonathan McCrohan1-2/+3 2014-07-23Imported Upstream version 0+git20140611.14bd6c7upstream/0+git20140611.14bd6c7Jonathan McCrohan7-11/+60 2014-05-13New Upstream Snapshot (commit 1246b27)Jonathan McCrohan1-0/+6 2014-05-13Imported Upstream version 0+git20140512.1246b27upstream/0+git20140512.1246b27Jonathan McCrohan391-301/+3983 2014-04-05Release 0+git20140326.cfc2975-1debian/0+git20140326.cfc2975-1Jonathan McCrohan1-2/+2 2014-04-05d/control: update Homepage (upstream has moved from Gitweb to cgit)Jonathan McCrohan2-1/+2 2014-04-05New Upstream Snapshot (commit cfc2975)Jonathan McCrohan1-0/+6 2014-04-05Imported Upstream version 0+git20140326.cfc2975upstream/0+git20140326.cfc2975Jonathan McCrohan118-656/+877 2014-01-16Release 0+git20140107.1850cf8-1debian/0+git20140107.1850cf8-1Jonathan McCrohan1-2/+2 2014-01-16Update Standards Version to 3.9.5Jonathan McCrohan2-1/+9