* CCID: Support PC To Reader Transfer Block data * Format sources Co-authored-by: あく <alleteam@gmail.com>
		
			
				
	
	
		
			170 lines
		
	
	
		
			4.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			170 lines
		
	
	
		
			4.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #include <stdint.h>
 | |
| #include <furi.h>
 | |
| #include <furi_hal.h>
 | |
| 
 | |
| #include <gui/view.h>
 | |
| #include <gui/view_dispatcher.h>
 | |
| #include <gui/modules/submenu.h>
 | |
| #include <gui/gui.h>
 | |
| 
 | |
| #include "iso7816_t0_apdu.h"
 | |
| 
 | |
| typedef enum {
 | |
|     EventTypeInput,
 | |
| } EventType;
 | |
| 
 | |
| typedef struct {
 | |
|     Gui* gui;
 | |
|     ViewPort* view_port;
 | |
|     FuriMessageQueue* event_queue;
 | |
|     FuriHalUsbCcidConfig ccid_cfg;
 | |
| } CcidTestApp;
 | |
| 
 | |
| typedef struct {
 | |
|     union {
 | |
|         InputEvent input;
 | |
|     };
 | |
|     EventType type;
 | |
| } CcidTestAppEvent;
 | |
| 
 | |
| typedef enum {
 | |
|     CcidTestSubmenuIndexInsertSmartcard,
 | |
|     CcidTestSubmenuIndexRemoveSmartcard,
 | |
|     CcidTestSubmenuIndexInsertSmartcardReader
 | |
| } SubmenuIndex;
 | |
| 
 | |
| void icc_power_on_callback(uint8_t* atrBuffer, uint32_t* atrlen, void* context) {
 | |
|     UNUSED(context);
 | |
| 
 | |
|     iso7816_answer_to_reset(atrBuffer, atrlen);
 | |
| }
 | |
| 
 | |
| //dataBlock points to the buffer
 | |
| //dataBlockLen tells reader how nany bytes should be read
 | |
| void xfr_datablock_callback(
 | |
|     const uint8_t* dataBlock,
 | |
|     uint32_t dataBlockLen,
 | |
|     uint8_t* responseDataBlock,
 | |
|     uint32_t* responseDataBlockLen,
 | |
|     void* context) {
 | |
|     UNUSED(context);
 | |
| 
 | |
|     struct ISO7816_Command_APDU commandAPDU;
 | |
|     iso7816_read_command_apdu(&commandAPDU, dataBlock, dataBlockLen);
 | |
| 
 | |
|     struct ISO7816_Response_APDU responseAPDU;
 | |
|     //class not supported
 | |
|     responseAPDU.SW1 = 0x6E;
 | |
|     responseAPDU.SW2 = 0x00;
 | |
| 
 | |
|     iso7816_write_response_apdu(&responseAPDU, responseDataBlock, responseDataBlockLen);
 | |
| }
 | |
| 
 | |
| static const CcidCallbacks ccid_cb = {
 | |
|     icc_power_on_callback,
 | |
|     xfr_datablock_callback,
 | |
| };
 | |
| 
 | |
| static void ccid_test_app_render_callback(Canvas* canvas, void* ctx) {
 | |
|     UNUSED(ctx);
 | |
|     canvas_clear(canvas);
 | |
| 
 | |
|     canvas_set_font(canvas, FontPrimary);
 | |
|     canvas_draw_str(canvas, 0, 10, "CCID Test App");
 | |
| 
 | |
|     canvas_set_font(canvas, FontSecondary);
 | |
|     canvas_draw_str(canvas, 0, 63, "Hold [back] to exit");
 | |
| }
 | |
| 
 | |
| static void ccid_test_app_input_callback(InputEvent* input_event, void* ctx) {
 | |
|     FuriMessageQueue* event_queue = ctx;
 | |
| 
 | |
|     CcidTestAppEvent event;
 | |
|     event.type = EventTypeInput;
 | |
|     event.input = *input_event;
 | |
|     furi_message_queue_put(event_queue, &event, FuriWaitForever);
 | |
| }
 | |
| 
 | |
| uint32_t ccid_test_exit(void* context) {
 | |
|     UNUSED(context);
 | |
|     return VIEW_NONE;
 | |
| }
 | |
| 
 | |
| CcidTestApp* ccid_test_app_alloc() {
 | |
|     CcidTestApp* app = malloc(sizeof(CcidTestApp));
 | |
| 
 | |
|     // Gui
 | |
|     app->gui = furi_record_open(RECORD_GUI);
 | |
| 
 | |
|     //viewport
 | |
|     app->view_port = view_port_alloc();
 | |
|     gui_add_view_port(app->gui, app->view_port, GuiLayerFullscreen);
 | |
|     view_port_draw_callback_set(app->view_port, ccid_test_app_render_callback, NULL);
 | |
| 
 | |
|     //message queue
 | |
|     app->event_queue = furi_message_queue_alloc(8, sizeof(CcidTestAppEvent));
 | |
|     furi_check(app->event_queue);
 | |
|     view_port_input_callback_set(app->view_port, ccid_test_app_input_callback, app->event_queue);
 | |
| 
 | |
|     return app;
 | |
| }
 | |
| 
 | |
| void ccid_test_app_free(CcidTestApp* app) {
 | |
|     furi_assert(app);
 | |
| 
 | |
|     //message queue
 | |
|     furi_message_queue_free(app->event_queue);
 | |
| 
 | |
|     //view port
 | |
|     gui_remove_view_port(app->gui, app->view_port);
 | |
|     view_port_free(app->view_port);
 | |
| 
 | |
|     // Close gui record
 | |
|     furi_record_close(RECORD_GUI);
 | |
|     app->gui = NULL;
 | |
| 
 | |
|     // Free rest
 | |
|     free(app);
 | |
| }
 | |
| 
 | |
| int32_t ccid_test_app(void* p) {
 | |
|     UNUSED(p);
 | |
| 
 | |
|     //setup view
 | |
|     CcidTestApp* app = ccid_test_app_alloc();
 | |
| 
 | |
|     //setup CCID USB
 | |
|     // On linux: set VID PID using: /usr/lib/pcsc/drivers/ifd-ccid.bundle/Contents/Info.plist
 | |
|     app->ccid_cfg.vid = 0x1234;
 | |
|     app->ccid_cfg.pid = 0x5678;
 | |
| 
 | |
|     FuriHalUsbInterface* usb_mode_prev = furi_hal_usb_get_config();
 | |
|     furi_hal_usb_unlock();
 | |
|     furi_hal_ccid_set_callbacks((CcidCallbacks*)&ccid_cb);
 | |
|     furi_check(furi_hal_usb_set_config(&usb_ccid, &app->ccid_cfg) == true);
 | |
| 
 | |
|     //handle button events
 | |
|     CcidTestAppEvent event;
 | |
|     while(1) {
 | |
|         FuriStatus event_status =
 | |
|             furi_message_queue_get(app->event_queue, &event, FuriWaitForever);
 | |
| 
 | |
|         if(event_status == FuriStatusOk) {
 | |
|             if(event.type == EventTypeInput) {
 | |
|                 if(event.input.type == InputTypeLong && event.input.key == InputKeyBack) {
 | |
|                     break;
 | |
|                 }
 | |
|             }
 | |
|         }
 | |
|         view_port_update(app->view_port);
 | |
|     }
 | |
| 
 | |
|     //tear down USB
 | |
|     furi_hal_usb_set_config(usb_mode_prev, NULL);
 | |
|     furi_hal_ccid_set_callbacks(NULL);
 | |
| 
 | |
|     //teardown view
 | |
|     ccid_test_app_free(app);
 | |
|     return 0;
 | |
| }
 |