Blame view

kernel/linux-rt-4.4.41/net/nfc/hci/llc_nop.c 2.35 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
  /*
   * nop (passthrough) Link Layer Control
   *
   * Copyright (C) 2012  Intel Corporation. All rights reserved.
   *
   * This program is free software; you can redistribute it and/or modify it
   * under the terms and conditions of the GNU General Public License,
   * version 2, as published by the Free Software Foundation.
   *
   * 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 General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program; if not, see <http://www.gnu.org/licenses/>.
   */
  
  #include <linux/types.h>
  
  #include "llc.h"
  
  struct llc_nop {
  	struct nfc_hci_dev *hdev;
  	xmit_to_drv_t xmit_to_drv;
  	rcv_to_hci_t rcv_to_hci;
  	int tx_headroom;
  	int tx_tailroom;
  	llc_failure_t llc_failure;
  };
  
  static void *llc_nop_init(struct nfc_hci_dev *hdev, xmit_to_drv_t xmit_to_drv,
  			  rcv_to_hci_t rcv_to_hci, int tx_headroom,
  			  int tx_tailroom, int *rx_headroom, int *rx_tailroom,
  			  llc_failure_t llc_failure)
  {
  	struct llc_nop *llc_nop;
  
  	*rx_headroom = 0;
  	*rx_tailroom = 0;
  
  	llc_nop = kzalloc(sizeof(struct llc_nop), GFP_KERNEL);
  	if (llc_nop == NULL)
  		return NULL;
  
  	llc_nop->hdev = hdev;
  	llc_nop->xmit_to_drv = xmit_to_drv;
  	llc_nop->rcv_to_hci = rcv_to_hci;
  	llc_nop->tx_headroom = tx_headroom;
  	llc_nop->tx_tailroom = tx_tailroom;
  	llc_nop->llc_failure = llc_failure;
  
  	return llc_nop;
  }
  
  static void llc_nop_deinit(struct nfc_llc *llc)
  {
  	kfree(nfc_llc_get_data(llc));
  }
  
  static int llc_nop_start(struct nfc_llc *llc)
  {
  	return 0;
  }
  
  static int llc_nop_stop(struct nfc_llc *llc)
  {
  	return 0;
  }
  
  static void llc_nop_rcv_from_drv(struct nfc_llc *llc, struct sk_buff *skb)
  {
  	struct llc_nop *llc_nop = nfc_llc_get_data(llc);
  
  	llc_nop->rcv_to_hci(llc_nop->hdev, skb);
  }
  
  static int llc_nop_xmit_from_hci(struct nfc_llc *llc, struct sk_buff *skb)
  {
  	struct llc_nop *llc_nop = nfc_llc_get_data(llc);
  
  	return llc_nop->xmit_to_drv(llc_nop->hdev, skb);
  }
  
  static struct nfc_llc_ops llc_nop_ops = {
  	.init = llc_nop_init,
  	.deinit = llc_nop_deinit,
  	.start = llc_nop_start,
  	.stop = llc_nop_stop,
  	.rcv_from_drv = llc_nop_rcv_from_drv,
  	.xmit_from_hci = llc_nop_xmit_from_hci,
  };
  
  int nfc_llc_nop_register(void)
  {
  	return nfc_llc_register(LLC_NOP_NAME, &llc_nop_ops);
  }