Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * nop (passthrough) Link Layer Control
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * Copyright (C) 2012  Intel Corporation. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include "llc.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) struct llc_nop {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	struct nfc_hci_dev *hdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	xmit_to_drv_t xmit_to_drv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 	rcv_to_hci_t rcv_to_hci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	int tx_headroom;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	int tx_tailroom;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 	llc_failure_t llc_failure;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) static void *llc_nop_init(struct nfc_hci_dev *hdev, xmit_to_drv_t xmit_to_drv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 			  rcv_to_hci_t rcv_to_hci, int tx_headroom,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 			  int tx_tailroom, int *rx_headroom, int *rx_tailroom,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 			  llc_failure_t llc_failure)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	struct llc_nop *llc_nop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	*rx_headroom = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	*rx_tailroom = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	llc_nop = kzalloc(sizeof(struct llc_nop), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	if (llc_nop == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	llc_nop->hdev = hdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	llc_nop->xmit_to_drv = xmit_to_drv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	llc_nop->rcv_to_hci = rcv_to_hci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	llc_nop->tx_headroom = tx_headroom;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	llc_nop->tx_tailroom = tx_tailroom;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	llc_nop->llc_failure = llc_failure;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	return llc_nop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) static void llc_nop_deinit(struct nfc_llc *llc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	kfree(nfc_llc_get_data(llc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) static int llc_nop_start(struct nfc_llc *llc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) static int llc_nop_stop(struct nfc_llc *llc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) static void llc_nop_rcv_from_drv(struct nfc_llc *llc, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	struct llc_nop *llc_nop = nfc_llc_get_data(llc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 	llc_nop->rcv_to_hci(llc_nop->hdev, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) static int llc_nop_xmit_from_hci(struct nfc_llc *llc, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	struct llc_nop *llc_nop = nfc_llc_get_data(llc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 	return llc_nop->xmit_to_drv(llc_nop->hdev, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static struct nfc_llc_ops llc_nop_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 	.init = llc_nop_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) 	.deinit = llc_nop_deinit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 	.start = llc_nop_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 	.stop = llc_nop_stop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 	.rcv_from_drv = llc_nop_rcv_from_drv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 	.xmit_from_hci = llc_nop_xmit_from_hci,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) int nfc_llc_nop_register(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) 	return nfc_llc_register(LLC_NOP_NAME, &llc_nop_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) }