[linux-block.git] / drivers / staging / wlan-ng / p80211req.c

// SPDX-License-Identifier: (GPL-2.0 OR MPL-1.1)
/*
 *
 * Request/Indication/MacMgmt interface handling functions
 *
 * Copyright (C) 1999 AbsoluteValue Systems, Inc.  All Rights Reserved.
 * --------------------------------------------------------------------
 *
 * linux-wlan
 *
 * --------------------------------------------------------------------
 *
 * Inquiries regarding the linux-wlan Open Source project can be
 * made directly to:
 *
 * AbsoluteValue Systems Inc.
 * info@linux-wlan.com
 * http://www.linux-wlan.com
 *
 * --------------------------------------------------------------------
 *
 * Portions of the development of this software were funded by
 * Intersil Corporation as part of PRISM(R) chipset product development.
 *
 * --------------------------------------------------------------------
 *
 * This file contains the functions, types, and macros to support the
 * MLME request interface that's implemented via the device ioctls.
 *
 * --------------------------------------------------------------------
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/types.h>
#include <linux/skbuff.h>
#include <linux/wireless.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <net/sock.h>
#include <linux/netlink.h>

#include "p80211types.h"
#include "p80211hdr.h"
#include "p80211mgmt.h"
#include "p80211conv.h"
#include "p80211msg.h"
#include "p80211netdev.h"
#include "p80211ioctl.h"
#include "p80211metadef.h"
#include "p80211metastruct.h"
#include "p80211req.h"

static void p80211req_handlemsg(struct wlandevice *wlandev,
				struct p80211msg *msg);
static void p80211req_mibset_mibget(struct wlandevice *wlandev,
				    struct p80211msg_dot11req_mibget *mib_msg,
				    int isget);

static void p80211req_handle_action(struct wlandevice *wlandev, u32 *data,
				    int isget, u32 flag)
{
	if (isget) {
		if (wlandev->hostwep & flag)
			*data = P80211ENUM_truth_true;
		else
			*data = P80211ENUM_truth_false;
	} else {
		wlandev->hostwep &= ~flag;
		if (*data == P80211ENUM_truth_true)
			wlandev->hostwep |= flag;
	}
}

/*----------------------------------------------------------------
 * p80211req_dorequest
 *
 * Handles an MLME request/confirm message.
 *
 * Arguments:
 *	wlandev		WLAN device struct
 *	msgbuf		Buffer containing a request message
 *
 * Returns:
 *	0 on success, an errno otherwise
 *
 * Call context:
 *	Potentially blocks the caller, so it's a good idea to
 *	not call this function from an interrupt context.
 *----------------------------------------------------------------
 */
int p80211req_dorequest(struct wlandevice *wlandev, u8 *msgbuf)
{
	struct p80211msg *msg = (struct p80211msg *)msgbuf;

	/* Check to make sure the MSD is running */
	if (!((wlandev->msdstate == WLAN_MSD_HWPRESENT &&
	       msg->msgcode == DIDMSG_LNXREQ_IFSTATE) ||
	      wlandev->msdstate == WLAN_MSD_RUNNING ||
	      wlandev->msdstate == WLAN_MSD_FWLOAD)) {
		return -ENODEV;
	}

	/* Check Permissions */
	if (!capable(CAP_NET_ADMIN) &&
	    (msg->msgcode != DIDMSG_DOT11REQ_MIBGET)) {
		netdev_err(wlandev->netdev,
			   "%s: only dot11req_mibget allowed for non-root.\n",
			   wlandev->name);
		return -EPERM;
	}

	/* Check for busy status */
	if (test_and_set_bit(1, &wlandev->request_pending))
		return -EBUSY;

	/* Allow p80211 to look at msg and handle if desired. */
	/* So far, all p80211 msgs are immediate, no waitq/timer necessary */
	/* This may change. */
	p80211req_handlemsg(wlandev, msg);

	/* Pass it down to wlandev via wlandev->mlmerequest */
	if (wlandev->mlmerequest)
		wlandev->mlmerequest(wlandev, msg);

	clear_bit(1, &wlandev->request_pending);
	return 0;	/* if result==0, msg->status still may contain an err */
}

/*----------------------------------------------------------------
 * p80211req_handlemsg
 *
 * p80211 message handler.  Primarily looks for messages that
 * belong to p80211 and then dispatches the appropriate response.
 * TODO: we don't do anything yet.  Once the linuxMIB is better
 *	defined we'll need a get/set handler.
 *
 * Arguments:
 *	wlandev		WLAN device struct
 *	msg		message structure
 *
 * Returns:
 *	nothing (any results are set in the status field of the msg)
 *
 * Call context:
 *	Process thread
 *----------------------------------------------------------------
 */
static void p80211req_handlemsg(struct wlandevice *wlandev,
				struct p80211msg *msg)
{
	switch (msg->msgcode) {
	case DIDMSG_LNXREQ_HOSTWEP: {
		struct p80211msg_lnxreq_hostwep *req =
			(struct p80211msg_lnxreq_hostwep *)msg;
		wlandev->hostwep &=
				~(HOSTWEP_DECRYPT | HOSTWEP_ENCRYPT);
		if (req->decrypt.data == P80211ENUM_truth_true)
			wlandev->hostwep |= HOSTWEP_DECRYPT;
		if (req->encrypt.data == P80211ENUM_truth_true)
			wlandev->hostwep |= HOSTWEP_ENCRYPT;

		break;
	}
	case DIDMSG_DOT11REQ_MIBGET:
	case DIDMSG_DOT11REQ_MIBSET: {
		int isget = (msg->msgcode == DIDMSG_DOT11REQ_MIBGET);
		struct p80211msg_dot11req_mibget *mib_msg =
			(struct p80211msg_dot11req_mibget *)msg;
		p80211req_mibset_mibget(wlandev, mib_msg, isget);
		break;
	}
	}			/* switch msg->msgcode */
}

static void p80211req_mibset_mibget(struct wlandevice *wlandev,
				    struct p80211msg_dot11req_mibget *mib_msg,
				    int isget)
{
	struct p80211itemd *mibitem =
		(struct p80211itemd *)mib_msg->mibattribute.data;
	struct p80211pstrd *pstr = (struct p80211pstrd *)mibitem->data;
	u8 *key = mibitem->data + sizeof(struct p80211pstrd);

	switch (mibitem->did) {
	case didmib_dot11smt_wepdefaultkeystable_key(1):
	case didmib_dot11smt_wepdefaultkeystable_key(2):
	case didmib_dot11smt_wepdefaultkeystable_key(3):
	case didmib_dot11smt_wepdefaultkeystable_key(4):
		if (!isget)
			wep_change_key(wlandev,
				       P80211DID_ITEM(mibitem->did) - 1,
				       key, pstr->len);
		break;

	case DIDMIB_DOT11SMT_PRIVACYTABLE_WEPDEFAULTKEYID: {
		u32 *data = (u32 *)mibitem->data;

		if (isget) {
			*data = wlandev->hostwep & HOSTWEP_DEFAULTKEY_MASK;
		} else {
			wlandev->hostwep &= ~(HOSTWEP_DEFAULTKEY_MASK);
			wlandev->hostwep |= (*data & HOSTWEP_DEFAULTKEY_MASK);
		}
		break;
	}
	case DIDMIB_DOT11SMT_PRIVACYTABLE_PRIVACYINVOKED: {
		u32 *data = (u32 *)mibitem->data;

		p80211req_handle_action(wlandev, data, isget,
					HOSTWEP_PRIVACYINVOKED);
		break;
	}
	case DIDMIB_DOT11SMT_PRIVACYTABLE_EXCLUDEUNENCRYPTED: {
		u32 *data = (u32 *)mibitem->data;

		p80211req_handle_action(wlandev, data, isget,
					HOSTWEP_EXCLUDEUNENCRYPTED);
		break;
	}
	}
}
Commit	Line	Data
f7056d33	1	// SPDX-License-Identifier: (GPL-2.0 OR MPL-1.1)
8ffd91d9	2	/*
3aa4ecf7 SP	3	*
	4	* Request/Indication/MacMgmt interface handling functions
	5	*
	6	* Copyright (C) 1999 AbsoluteValue Systems, Inc. All Rights Reserved.
	7	* --------------------------------------------------------------------
	8	*
	9	* linux-wlan
	10	*
3aa4ecf7 SP	11	* --------------------------------------------------------------------
	12	*
	13	* Inquiries regarding the linux-wlan Open Source project can be
	14	* made directly to:
	15	*
	16	* AbsoluteValue Systems Inc.
	17	* info@linux-wlan.com
	18	* http://www.linux-wlan.com
	19	*
	20	* --------------------------------------------------------------------
	21	*
	22	* Portions of the development of this software were funded by
	23	* Intersil Corporation as part of PRISM(R) chipset product development.
	24	*
	25	* --------------------------------------------------------------------
	26	*
	27	* This file contains the functions, types, and macros to support the
	28	* MLME request interface that's implemented via the device ioctls.
	29	*
	30	* --------------------------------------------------------------------
	31	*/
00b3ed16	32
00b3ed16 GKH	33	#include <linux/module.h>
	34	#include <linux/kernel.h>
	35	#include <linux/sched.h>
	36	#include <linux/types.h>
	37	#include <linux/skbuff.h>
00b3ed16 GKH	38	#include <linux/wireless.h>
	39	#include <linux/netdevice.h>
	40	#include <linux/etherdevice.h>
	41	#include <net/sock.h>
	42	#include <linux/netlink.h>
	43
00b3ed16 GKH	44	#include "p80211types.h"
	45	#include "p80211hdr.h"
	46	#include "p80211mgmt.h"
	47	#include "p80211conv.h"
	48	#include "p80211msg.h"
	49	#include "p80211netdev.h"
	50	#include "p80211ioctl.h"
	51	#include "p80211metadef.h"
	52	#include "p80211metastruct.h"
	53	#include "p80211req.h"
	54
c97efa34 SP	55	static void p80211req_handlemsg(struct wlandevice *wlandev,
c97efa34 SP	56	struct p80211msg *msg);
c9573a8d	57	static void p80211req_mibset_mibget(struct wlandevice *wlandev,
b1f3b305 SP	58	struct p80211msg_dot11req_mibget *mib_msg,
b1f3b305 SP	59	int isget);
00b3ed16	60
2f479125 CB	61	static void p80211req_handle_action(struct wlandevice wlandev, u32 data,
	62	int isget, u32 flag)
	63	{
	64	if (isget) {
	65	if (wlandev->hostwep & flag)
	66	*data = P80211ENUM_truth_true;
	67	else
	68	*data = P80211ENUM_truth_false;
	69	} else {
	70	wlandev->hostwep &= ~flag;
	71	if (*data == P80211ENUM_truth_true)
	72	wlandev->hostwep \|= flag;
	73	}
	74	}
	75
00b3ed16	76	/*----------------------------------------------------------------
3aa4ecf7 SP	77	* p80211req_dorequest
	78	*
	79	* Handles an MLME request/confirm message.
	80	*
	81	* Arguments:
	82	* wlandev WLAN device struct
	83	* msgbuf Buffer containing a request message
	84	*
	85	* Returns:
	86	* 0 on success, an errno otherwise
	87	*
	88	* Call context:
	89	* Potentially blocks the caller, so it's a good idea to
	90	* not call this function from an interrupt context.
	91	*----------------------------------------------------------------
	92	*/
c9573a8d	93	int p80211req_dorequest(struct wlandevice wlandev, u8 msgbuf)
00b3ed16	94	{
0e21fa46	95	struct p80211msg msg = (struct p80211msg )msgbuf;
00b3ed16	96
00b3ed16	97	/* Check to make sure the MSD is running */
b1de9675	98	if (!((wlandev->msdstate == WLAN_MSD_HWPRESENT &&
eb7c161c	99	msg->msgcode == DIDMSG_LNXREQ_IFSTATE) \|\|
b1de9675 MM	100	wlandev->msdstate == WLAN_MSD_RUNNING \|\|
b1de9675 MM	101	wlandev->msdstate == WLAN_MSD_FWLOAD)) {
00b3ed16 GKH	102	return -ENODEV;
	103	}
	104
	105	/* Check Permissions */
67a7b378	106	if (!capable(CAP_NET_ADMIN) &&
08ac8573	107	(msg->msgcode != DIDMSG_DOT11REQ_MIBGET)) {
02d9b1eb VO	108	netdev_err(wlandev->netdev,
	109	"%s: only dot11req_mibget allowed for non-root.\n",
	110	wlandev->name);
00b3ed16 GKH	111	return -EPERM;
	112	}
	113
	114	/* Check for busy status */
d4e1818a	115	if (test_and_set_bit(1, &wlandev->request_pending))
00b3ed16	116	return -EBUSY;
00b3ed16 GKH	117
	118	/* Allow p80211 to look at msg and handle if desired. */
	119	/* So far, all p80211 msgs are immediate, no waitq/timer necessary */
	120	/* This may change. */
	121	p80211req_handlemsg(wlandev, msg);
	122
	123	/* Pass it down to wlandev via wlandev->mlmerequest */
6c55d50e	124	if (wlandev->mlmerequest)
00b3ed16 GKH	125	wlandev->mlmerequest(wlandev, msg);
00b3ed16 GKH	126
d4e1818a	127	clear_bit(1, &wlandev->request_pending);
4764ca98	128	return 0; /* if result==0, msg->status still may contain an err */
00b3ed16 GKH	129	}
	130
	131	/*----------------------------------------------------------------
3aa4ecf7 SP	132	* p80211req_handlemsg
	133	*
	134	* p80211 message handler. Primarily looks for messages that
	135	* belong to p80211 and then dispatches the appropriate response.
	136	* TODO: we don't do anything yet. Once the linuxMIB is better
	137	* defined we'll need a get/set handler.
	138	*
	139	* Arguments:
	140	* wlandev WLAN device struct
	141	* msg message structure
	142	*
	143	* Returns:
	144	* nothing (any results are set in the status field of the msg)
	145	*
	146	* Call context:
	147	* Process thread
	148	*----------------------------------------------------------------
	149	*/
c97efa34 SP	150	static void p80211req_handlemsg(struct wlandevice *wlandev,
c97efa34 SP	151	struct p80211msg *msg)
00b3ed16	152	{
00b3ed16	153	switch (msg->msgcode) {
27575665	154	case DIDMSG_LNXREQ_HOSTWEP: {
009629ef	155	struct p80211msg_lnxreq_hostwep *req =
0e21fa46	156	(struct p80211msg_lnxreq_hostwep *)msg;
009629ef DN	157	wlandev->hostwep &=
	158	~(HOSTWEP_DECRYPT \| HOSTWEP_ENCRYPT);
	159	if (req->decrypt.data == P80211ENUM_truth_true)
	160	wlandev->hostwep \|= HOSTWEP_DECRYPT;
	161	if (req->encrypt.data == P80211ENUM_truth_true)
	162	wlandev->hostwep \|= HOSTWEP_ENCRYPT;
00b3ed16	163
27575665	164	break;
009629ef	165	}
08ac8573	166	case DIDMSG_DOT11REQ_MIBGET:
27575665	167	case DIDMSG_DOT11REQ_MIBSET: {
08ac8573	168	int isget = (msg->msgcode == DIDMSG_DOT11REQ_MIBGET);
009629ef	169	struct p80211msg_dot11req_mibget *mib_msg =
0e21fa46	170	(struct p80211msg_dot11req_mibget *)msg;
009629ef	171	p80211req_mibset_mibget(wlandev, mib_msg, isget);
27575665	172	break;
009629ef	173	}
b1de9675	174	} /* switch msg->msgcode */
00b3ed16 GKH	175	}
00b3ed16 GKH	176
c9573a8d	177	static void p80211req_mibset_mibget(struct wlandevice *wlandev,
b1f3b305 SP	178	struct p80211msg_dot11req_mibget *mib_msg,
b1f3b305 SP	179	int isget)
00b3ed16	180	{
17475c50 IC	181	struct p80211itemd *mibitem =
17475c50 IC	182	(struct p80211itemd *)mib_msg->mibattribute.data;
3fd1e3fc SP	183	struct p80211pstrd pstr = (struct p80211pstrd )mibitem->data;
3fd1e3fc SP	184	u8 *key = mibitem->data + sizeof(struct p80211pstrd);
00b3ed16	185
00b3ed16	186	switch (mibitem->did) {
ce0f34e4 TC	187	case didmib_dot11smt_wepdefaultkeystable_key(1):
	188	case didmib_dot11smt_wepdefaultkeystable_key(2):
	189	case didmib_dot11smt_wepdefaultkeystable_key(3):
	190	case didmib_dot11smt_wepdefaultkeystable_key(4):
7694538c	191	if (!isget)
37f92cf0 CB	192	wep_change_key(wlandev,
	193	P80211DID_ITEM(mibitem->did) - 1,
	194	key, pstr->len);
	195	break;
	196
27575665	197	case DIDMIB_DOT11SMT_PRIVACYTABLE_WEPDEFAULTKEYID: {
0e21fa46	198	u32 data = (u32 )mibitem->data;
00b3ed16	199
7694538c DN	200	if (isget) {
	201	*data = wlandev->hostwep & HOSTWEP_DEFAULTKEY_MASK;
	202	} else {
	203	wlandev->hostwep &= ~(HOSTWEP_DEFAULTKEY_MASK);
	204	wlandev->hostwep \|= (*data & HOSTWEP_DEFAULTKEY_MASK);
b1de9675	205	}
27575665	206	break;
7694538c	207	}
27575665	208	case DIDMIB_DOT11SMT_PRIVACYTABLE_PRIVACYINVOKED: {
0e21fa46	209	u32 data = (u32 )mibitem->data;
7694538c	210
2f479125 CB	211	p80211req_handle_action(wlandev, data, isget,
2f479125 CB	212	HOSTWEP_PRIVACYINVOKED);
27575665	213	break;
7694538c	214	}
27575665	215	case DIDMIB_DOT11SMT_PRIVACYTABLE_EXCLUDEUNENCRYPTED: {
0e21fa46	216	u32 data = (u32 )mibitem->data;
7694538c	217
2f479125 CB	218	p80211req_handle_action(wlandev, data, isget,
2f479125 CB	219	HOSTWEP_EXCLUDEUNENCRYPTED);
27575665	220	break;
7694538c	221	}
00b3ed16	222	}
00b3ed16	223	}