Lines Matching refs:ddev
106 static void digital_in_recv_dep_res(struct nfc_digital_dev *ddev, void *arg,
108 static void digital_tg_recv_dep_req(struct nfc_digital_dev *ddev, void *arg,
168 static void digital_skb_push_dep_sod(struct nfc_digital_dev *ddev,
175 if (ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)
179 static int digital_skb_pull_dep_sod(struct nfc_digital_dev *ddev,
187 if (ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)
200 digital_send_dep_data_prep(struct nfc_digital_dev *ddev, struct sk_buff *skb,
206 if (skb->len > ddev->remote_payload_max) {
209 new_skb = digital_skb_alloc(ddev, ddev->remote_payload_max);
211 kfree_skb(ddev->chaining_skb);
212 ddev->chaining_skb = NULL;
217 skb_put_data(new_skb, skb->data, ddev->remote_payload_max);
218 skb_pull(skb, ddev->remote_payload_max);
220 ddev->chaining_skb = skb;
221 ddev->data_exch = data_exch;
223 ddev->chaining_skb = NULL;
231 digital_recv_dep_data_gather(struct nfc_digital_dev *ddev, u8 pfb,
233 int (*send_ack)(struct nfc_digital_dev *ddev,
241 if (DIGITAL_NFC_DEP_MI_BIT_SET(pfb) && (!ddev->chaining_skb)) {
242 ddev->chaining_skb =
243 nfc_alloc_recv_skb(8 * ddev->local_payload_max,
245 if (!ddev->chaining_skb) {
251 if (ddev->chaining_skb) {
252 if (resp->len > skb_tailroom(ddev->chaining_skb)) {
253 new_skb = skb_copy_expand(ddev->chaining_skb,
255 ddev->chaining_skb),
256 8 * ddev->local_payload_max,
263 kfree_skb(ddev->chaining_skb);
264 ddev->chaining_skb = new_skb;
267 skb_put_data(ddev->chaining_skb, resp->data, resp->len);
273 rc = send_ack(ddev, data_exch);
280 resp = ddev->chaining_skb;
281 ddev->chaining_skb = NULL;
289 kfree_skb(ddev->chaining_skb);
290 ddev->chaining_skb = NULL;
295 static void digital_in_recv_psl_res(struct nfc_digital_dev *ddev, void *arg,
308 rc = ddev->skb_check_crc(resp);
314 rc = digital_skb_pull_dep_sod(ddev, resp);
329 rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
334 rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
339 if (!DIGITAL_DRV_CAPS_IN_CRC(ddev) &&
340 (ddev->curr_rf_tech == NFC_DIGITAL_RF_TECH_106A)) {
341 ddev->skb_add_crc = digital_skb_add_crc_f;
342 ddev->skb_check_crc = digital_skb_check_crc_f;
345 ddev->curr_rf_tech = NFC_DIGITAL_RF_TECH_424F;
347 nfc_dep_link_is_up(ddev->nfc_dev, target->idx, NFC_COMM_ACTIVE,
350 ddev->curr_nfc_dep_pni = 0;
356 ddev->curr_protocol = 0;
359 static int digital_in_send_psl_req(struct nfc_digital_dev *ddev,
367 skb = digital_skb_alloc(ddev, sizeof(*psl_req));
380 payload_size = min(ddev->local_payload_max, ddev->remote_payload_max);
384 ddev->local_payload_max = payload_size;
385 ddev->remote_payload_max = payload_size;
387 digital_skb_push_dep_sod(ddev, skb);
389 ddev->skb_add_crc(skb);
391 rc = digital_in_send_cmd(ddev, skb, ddev->dep_rwt,
399 static void digital_in_recv_atr_res(struct nfc_digital_dev *ddev, void *arg,
414 rc = ddev->skb_check_crc(resp);
420 rc = digital_skb_pull_dep_sod(ddev, resp);
438 ddev->dep_rwt = digital_rwt_map[wt];
441 ddev->remote_payload_max = digital_payload_bits_to_size(payload_bits);
443 if (!ddev->remote_payload_max) {
448 rc = nfc_set_remote_general_bytes(ddev->nfc_dev, atr_res->gb, gb_len);
452 if ((ddev->protocols & NFC_PROTO_FELICA_MASK) &&
453 (ddev->curr_rf_tech != NFC_DIGITAL_RF_TECH_424F)) {
454 rc = digital_in_send_psl_req(ddev, target);
459 rc = nfc_dep_link_is_up(ddev->nfc_dev, target->idx, NFC_COMM_ACTIVE,
462 ddev->curr_nfc_dep_pni = 0;
468 ddev->curr_protocol = 0;
471 int digital_in_send_atr_req(struct nfc_digital_dev *ddev,
488 skb = digital_skb_alloc(ddev, size);
508 ddev->local_payload_max = DIGITAL_PAYLOAD_SIZE_MAX;
509 payload_bits = digital_payload_size_to_bits(ddev->local_payload_max);
517 digital_skb_push_dep_sod(ddev, skb);
519 ddev->skb_add_crc(skb);
521 rc = digital_in_send_cmd(ddev, skb, DIGITAL_ATR_RES_RWT,
529 static int digital_in_send_ack(struct nfc_digital_dev *ddev,
536 skb = digital_skb_alloc(ddev, 1);
547 ddev->curr_nfc_dep_pni;
549 digital_skb_push_dep_sod(ddev, skb);
551 ddev->skb_add_crc(skb);
553 ddev->saved_skb = pskb_copy(skb, GFP_KERNEL);
555 rc = digital_in_send_cmd(ddev, skb, ddev->dep_rwt,
559 kfree_skb(ddev->saved_skb);
560 ddev->saved_skb = NULL;
566 static int digital_in_send_nack(struct nfc_digital_dev *ddev,
573 skb = digital_skb_alloc(ddev, 1);
584 DIGITAL_NFC_DEP_PFB_NACK_BIT | ddev->curr_nfc_dep_pni;
586 digital_skb_push_dep_sod(ddev, skb);
588 ddev->skb_add_crc(skb);
590 rc = digital_in_send_cmd(ddev, skb, ddev->dep_rwt,
598 static int digital_in_send_atn(struct nfc_digital_dev *ddev,
605 skb = digital_skb_alloc(ddev, 1);
617 digital_skb_push_dep_sod(ddev, skb);
619 ddev->skb_add_crc(skb);
621 rc = digital_in_send_cmd(ddev, skb, ddev->dep_rwt,
629 static int digital_in_send_rtox(struct nfc_digital_dev *ddev,
637 rwt_int = ddev->dep_rwt * rtox;
641 skb = digital_skb_alloc(ddev, 1);
656 digital_skb_push_dep_sod(ddev, skb);
658 ddev->skb_add_crc(skb);
660 rc = digital_in_send_cmd(ddev, skb, rwt_int,
668 static int digital_in_send_saved_skb(struct nfc_digital_dev *ddev,
673 if (!ddev->saved_skb)
676 skb_get(ddev->saved_skb);
678 rc = digital_in_send_cmd(ddev, ddev->saved_skb, ddev->dep_rwt,
681 kfree_skb(ddev->saved_skb);
686 static void digital_in_recv_dep_res(struct nfc_digital_dev *ddev, void *arg,
700 if ((rc == -EIO || (rc == -ETIMEDOUT && ddev->nack_count)) &&
701 (ddev->nack_count++ < DIGITAL_NFC_DEP_N_RETRY_NACK)) {
702 ddev->atn_count = 0;
704 rc = digital_in_send_nack(ddev, data_exch);
710 (ddev->atn_count++ < DIGITAL_NFC_DEP_N_RETRY_ATN)) {
711 ddev->nack_count = 0;
713 rc = digital_in_send_atn(ddev, data_exch);
723 rc = digital_skb_pull_dep_sod(ddev, resp);
729 rc = ddev->skb_check_crc(resp);
732 (ddev->nack_count++ < DIGITAL_NFC_DEP_N_RETRY_NACK)) {
733 ddev->atn_count = 0;
735 rc = digital_in_send_nack(ddev, data_exch);
748 ddev->atn_count = 0;
749 ddev->nack_count = 0;
751 if (resp->len > ddev->local_payload_max) {
787 if (DIGITAL_NFC_DEP_PFB_PNI(pfb) != ddev->curr_nfc_dep_pni) {
793 ddev->curr_nfc_dep_pni =
794 DIGITAL_NFC_DEP_PFB_PNI(ddev->curr_nfc_dep_pni + 1);
796 kfree_skb(ddev->saved_skb);
797 ddev->saved_skb = NULL;
799 resp = digital_recv_dep_data_gather(ddev, pfb, resp,
825 if (DIGITAL_NFC_DEP_PFB_PNI(pfb) != ddev->curr_nfc_dep_pni) {
831 ddev->curr_nfc_dep_pni =
832 DIGITAL_NFC_DEP_PFB_PNI(ddev->curr_nfc_dep_pni + 1);
834 if (!ddev->chaining_skb) {
843 kfree_skb(ddev->saved_skb);
844 ddev->saved_skb = NULL;
846 rc = digital_in_send_dep_req(ddev, NULL,
847 ddev->chaining_skb,
848 ddev->data_exch);
856 rc = digital_in_send_saved_skb(ddev, data_exch);
863 if (ddev->atn_count || ddev->nack_count) {
876 rc = digital_in_send_rtox(ddev, data_exch, rtox);
889 kfree_skb(ddev->chaining_skb);
890 ddev->chaining_skb = NULL;
892 kfree_skb(ddev->saved_skb);
893 ddev->saved_skb = NULL;
904 int digital_in_send_dep_req(struct nfc_digital_dev *ddev,
918 dep_req->pfb = ddev->curr_nfc_dep_pni;
920 ddev->atn_count = 0;
921 ddev->nack_count = 0;
923 chaining_skb = ddev->chaining_skb;
925 tmp_skb = digital_send_dep_data_prep(ddev, skb, dep_req, data_exch);
929 digital_skb_push_dep_sod(ddev, tmp_skb);
931 ddev->skb_add_crc(tmp_skb);
933 ddev->saved_skb = pskb_copy(tmp_skb, GFP_KERNEL);
935 rc = digital_in_send_cmd(ddev, tmp_skb, ddev->dep_rwt,
942 ddev->chaining_skb = NULL;
944 kfree_skb(ddev->saved_skb);
945 ddev->saved_skb = NULL;
951 static void digital_tg_set_rf_tech(struct nfc_digital_dev *ddev, u8 rf_tech)
953 ddev->curr_rf_tech = rf_tech;
955 ddev->skb_add_crc = digital_skb_add_crc_none;
956 ddev->skb_check_crc = digital_skb_check_crc_none;
958 if (DIGITAL_DRV_CAPS_TG_CRC(ddev))
961 switch (ddev->curr_rf_tech) {
963 ddev->skb_add_crc = digital_skb_add_crc_a;
964 ddev->skb_check_crc = digital_skb_check_crc_a;
969 ddev->skb_add_crc = digital_skb_add_crc_f;
970 ddev->skb_check_crc = digital_skb_check_crc_f;
978 static int digital_tg_send_ack(struct nfc_digital_dev *ddev,
985 skb = digital_skb_alloc(ddev, 1);
996 ddev->curr_nfc_dep_pni;
998 if (ddev->did) {
1001 skb_put_data(skb, &ddev->did, sizeof(ddev->did));
1004 ddev->curr_nfc_dep_pni =
1005 DIGITAL_NFC_DEP_PFB_PNI(ddev->curr_nfc_dep_pni + 1);
1007 digital_skb_push_dep_sod(ddev, skb);
1009 ddev->skb_add_crc(skb);
1011 ddev->saved_skb = pskb_copy(skb, GFP_KERNEL);
1013 rc = digital_tg_send_cmd(ddev, skb, 1500, digital_tg_recv_dep_req,
1017 kfree_skb(ddev->saved_skb);
1018 ddev->saved_skb = NULL;
1024 static int digital_tg_send_atn(struct nfc_digital_dev *ddev)
1030 skb = digital_skb_alloc(ddev, 1);
1042 if (ddev->did) {
1045 skb_put_data(skb, &ddev->did, sizeof(ddev->did));
1048 digital_skb_push_dep_sod(ddev, skb);
1050 ddev->skb_add_crc(skb);
1052 rc = digital_tg_send_cmd(ddev, skb, 1500, digital_tg_recv_dep_req,
1060 static int digital_tg_send_saved_skb(struct nfc_digital_dev *ddev)
1064 if (!ddev->saved_skb)
1067 skb_get(ddev->saved_skb);
1069 rc = digital_tg_send_cmd(ddev, ddev->saved_skb, 1500,
1072 kfree_skb(ddev->saved_skb);
1077 static void digital_tg_recv_dep_req(struct nfc_digital_dev *ddev, void *arg,
1091 rc = ddev->skb_check_crc(resp);
1097 rc = digital_skb_pull_dep_sod(ddev, resp);
1103 if (resp->len > ddev->local_payload_max) {
1120 if (ddev->did && (ddev->did == resp->data[3])) {
1126 } else if (ddev->did) {
1147 if (ddev->atn_count) {
1151 ddev->atn_count = 0;
1160 DIGITAL_NFC_DEP_PFB_PNI(ddev->curr_nfc_dep_pni - 1)) {
1161 rc = digital_tg_send_saved_skb(ddev);
1175 if (DIGITAL_NFC_DEP_PFB_PNI(pfb) != ddev->curr_nfc_dep_pni) {
1181 kfree_skb(ddev->saved_skb);
1182 ddev->saved_skb = NULL;
1184 resp = digital_recv_dep_data_gather(ddev, pfb, resp,
1204 ddev->curr_nfc_dep_pni) {
1209 ddev->atn_count = 0;
1211 rc = digital_tg_send_saved_skb(ddev);
1219 if (ddev->atn_count) {
1223 ddev->atn_count = 0;
1230 ddev->curr_nfc_dep_pni) {
1231 rc = digital_tg_send_saved_skb(ddev);
1245 if (!ddev->chaining_skb ||
1247 ddev->curr_nfc_dep_pni) {
1252 kfree_skb(ddev->saved_skb);
1253 ddev->saved_skb = NULL;
1255 rc = digital_tg_send_dep_res(ddev, ddev->chaining_skb);
1266 rc = digital_tg_send_atn(ddev);
1270 ddev->atn_count++;
1275 rc = nfc_tm_data_received(ddev->nfc_dev, resp);
1280 kfree_skb(ddev->chaining_skb);
1281 ddev->chaining_skb = NULL;
1283 ddev->atn_count = 0;
1285 kfree_skb(ddev->saved_skb);
1286 ddev->saved_skb = NULL;
1297 int digital_tg_send_dep_res(struct nfc_digital_dev *ddev, struct sk_buff *skb)
1309 dep_res->pfb = ddev->curr_nfc_dep_pni;
1311 if (ddev->did) {
1314 skb_put_data(skb, &ddev->did, sizeof(ddev->did));
1317 ddev->curr_nfc_dep_pni =
1318 DIGITAL_NFC_DEP_PFB_PNI(ddev->curr_nfc_dep_pni + 1);
1320 chaining_skb = ddev->chaining_skb;
1322 tmp_skb = digital_send_dep_data_prep(ddev, skb, dep_res, NULL);
1326 digital_skb_push_dep_sod(ddev, tmp_skb);
1328 ddev->skb_add_crc(tmp_skb);
1330 ddev->saved_skb = pskb_copy(tmp_skb, GFP_KERNEL);
1332 rc = digital_tg_send_cmd(ddev, tmp_skb, 1500, digital_tg_recv_dep_req,
1339 ddev->chaining_skb = NULL;
1341 kfree_skb(ddev->saved_skb);
1342 ddev->saved_skb = NULL;
1348 static void digital_tg_send_psl_res_complete(struct nfc_digital_dev *ddev,
1356 digital_tg_set_rf_tech(ddev, rf_tech);
1358 digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech);
1360 digital_tg_listen(ddev, 1500, digital_tg_recv_dep_req, NULL);
1365 static int digital_tg_send_psl_res(struct nfc_digital_dev *ddev, u8 did,
1372 skb = digital_skb_alloc(ddev, sizeof(struct digital_psl_res));
1384 digital_skb_push_dep_sod(ddev, skb);
1386 ddev->skb_add_crc(skb);
1388 ddev->curr_nfc_dep_pni = 0;
1390 rc = digital_tg_send_cmd(ddev, skb, 0, digital_tg_send_psl_res_complete,
1398 static void digital_tg_recv_psl_req(struct nfc_digital_dev *ddev, void *arg,
1412 rc = ddev->skb_check_crc(resp);
1418 rc = digital_skb_pull_dep_sod(ddev, resp);
1452 if (!payload_size || (payload_size > min(ddev->local_payload_max,
1453 ddev->remote_payload_max))) {
1458 ddev->local_payload_max = payload_size;
1459 ddev->remote_payload_max = payload_size;
1461 rc = digital_tg_send_psl_res(ddev, psl_req->did, rf_tech);
1467 static void digital_tg_send_atr_res_complete(struct nfc_digital_dev *ddev,
1473 digital_poll_next_tech(ddev);
1481 ddev->atn_count = 0;
1484 digital_tg_recv_psl_req(ddev, arg, resp);
1486 digital_tg_recv_dep_req(ddev, arg, resp);
1489 static int digital_tg_send_atr_res(struct nfc_digital_dev *ddev,
1498 gb = nfc_get_local_general_bytes(ddev->nfc_dev, &gb_len);
1502 skb = digital_skb_alloc(ddev, sizeof(struct digital_atr_res) + gb_len);
1516 ddev->local_payload_max = DIGITAL_PAYLOAD_SIZE_MAX;
1517 payload_bits = digital_payload_size_to_bits(ddev->local_payload_max);
1527 digital_skb_push_dep_sod(ddev, skb);
1529 ddev->skb_add_crc(skb);
1531 ddev->curr_nfc_dep_pni = 0;
1533 rc = digital_tg_send_cmd(ddev, skb, 999,
1541 void digital_tg_recv_atr_req(struct nfc_digital_dev *ddev, void *arg,
1562 digital_tg_set_rf_tech(ddev, NFC_DIGITAL_RF_TECH_106A);
1565 digital_tg_set_rf_tech(ddev, NFC_DIGITAL_RF_TECH_212F);
1573 ddev->curr_protocol = NFC_PROTO_NFC_DEP_MASK;
1575 rc = ddev->skb_check_crc(resp);
1581 rc = digital_skb_pull_dep_sod(ddev, resp);
1597 ddev->remote_payload_max = digital_payload_bits_to_size(payload_bits);
1599 if (!ddev->remote_payload_max) {
1604 ddev->did = atr_req->did;
1606 rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
1611 rc = digital_tg_send_atr_res(ddev, atr_req);
1617 poll_tech_count = ddev->poll_tech_count;
1618 ddev->poll_tech_count = 0;
1620 rc = nfc_tm_activated(ddev->nfc_dev, NFC_PROTO_NFC_DEP_MASK,
1623 ddev->poll_tech_count = poll_tech_count;
1630 digital_poll_next_tech(ddev);