Commit 73d6ac63 authored by Stephen Hemminger's avatar Stephen Hemminger Committed by David S. Miller

caif: code cleanup

Cleanup of new CAIF code.
  * make local functions static
  * remove code that is never used
  * expand get_caif_conf() since wrapper is no longer needed
  * make args to comparison functions const
  * rename connect_req_to_link_param to keep exported names
    consistent

Compile tested only.
Signed-off-by: default avatarStephen Hemminger <shemminger@vyatta.com>
Acked-by: default avatarSjur Brændeland <sjur.brandeland@stericsson.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 1c01a80c
...@@ -74,19 +74,8 @@ int caif_connect_client(struct caif_connect_request *conn_req, ...@@ -74,19 +74,8 @@ int caif_connect_client(struct caif_connect_request *conn_req,
int caif_disconnect_client(struct cflayer *client_layer); int caif_disconnect_client(struct cflayer *client_layer);
/** /**
* caif_release_client - Release adaptation layer reference to client. * caif_connect_req_to_link_param - Translate configuration parameters
* * from socket format to internal format.
* @client_layer: Client layer.
*
* Releases a client/adaptation layer use of the caif stack.
* This function must be used after caif_disconnect_client to
* decrease the reference count of the service layer.
*/
void caif_release_client(struct cflayer *client_layer);
/**
* connect_req_to_link_param - Translate configuration parameters
* from socket format to internal format.
* @cnfg: Pointer to configuration handler * @cnfg: Pointer to configuration handler
* @con_req: Configuration parameters supplied in function * @con_req: Configuration parameters supplied in function
* caif_connect_client * caif_connect_client
...@@ -94,14 +83,8 @@ void caif_release_client(struct cflayer *client_layer); ...@@ -94,14 +83,8 @@ void caif_release_client(struct cflayer *client_layer);
* setting up channels. * setting up channels.
* *
*/ */
int connect_req_to_link_param(struct cfcnfg *cnfg, int caif_connect_req_to_link_param(struct cfcnfg *cnfg,
struct caif_connect_request *con_req, struct caif_connect_request *con_req,
struct cfctrl_link_param *channel_setup_param); struct cfctrl_link_param *setup_param);
/**
* get_caif_conf() - Get the configuration handler.
*/
struct cfcnfg *get_caif_conf(void);
#endif /* CAIF_DEV_H_ */ #endif /* CAIF_DEV_H_ */
...@@ -121,19 +121,9 @@ int cfctrl_linkup_request(struct cflayer *cfctrl, ...@@ -121,19 +121,9 @@ int cfctrl_linkup_request(struct cflayer *cfctrl,
struct cflayer *user_layer); struct cflayer *user_layer);
int cfctrl_linkdown_req(struct cflayer *cfctrl, u8 linkid, int cfctrl_linkdown_req(struct cflayer *cfctrl, u8 linkid,
struct cflayer *client); struct cflayer *client);
void cfctrl_sleep_req(struct cflayer *cfctrl);
void cfctrl_wake_req(struct cflayer *cfctrl);
void cfctrl_getstartreason_req(struct cflayer *cfctrl);
struct cflayer *cfctrl_create(void); struct cflayer *cfctrl_create(void);
void cfctrl_set_dnlayer(struct cflayer *this, struct cflayer *dn);
void cfctrl_set_uplayer(struct cflayer *this, struct cflayer *up);
struct cfctrl_rsp *cfctrl_get_respfuncs(struct cflayer *layer); struct cfctrl_rsp *cfctrl_get_respfuncs(struct cflayer *layer);
bool cfctrl_req_eq(struct cfctrl_request_info *r1,
struct cfctrl_request_info *r2);
void cfctrl_insert_req(struct cfctrl *ctrl,
struct cfctrl_request_info *req);
struct cfctrl_request_info *cfctrl_remove_req(struct cfctrl *ctrl,
struct cfctrl_request_info *req);
void cfctrl_cancel_req(struct cflayer *layr, struct cflayer *adap_layer); void cfctrl_cancel_req(struct cflayer *layr, struct cflayer *adap_layer);
#endif /* CFCTRL_H_ */ #endif /* CFCTRL_H_ */
...@@ -16,7 +16,5 @@ int cfmuxl_set_uplayer(struct cflayer *layr, struct cflayer *up, u8 linkid); ...@@ -16,7 +16,5 @@ int cfmuxl_set_uplayer(struct cflayer *layr, struct cflayer *up, u8 linkid);
struct cflayer *cfmuxl_remove_dnlayer(struct cflayer *layr, u8 phyid); struct cflayer *cfmuxl_remove_dnlayer(struct cflayer *layr, u8 phyid);
int cfmuxl_set_dnlayer(struct cflayer *layr, struct cflayer *up, u8 phyid); int cfmuxl_set_dnlayer(struct cflayer *layr, struct cflayer *up, u8 phyid);
struct cflayer *cfmuxl_remove_uplayer(struct cflayer *layr, u8 linkid); struct cflayer *cfmuxl_remove_uplayer(struct cflayer *layr, u8 linkid);
bool cfmuxl_is_phy_inuse(struct cflayer *layr, u8 phyid);
u8 cfmuxl_get_phyid(struct cflayer *layr, u8 channel_id);
#endif /* CFMUXL_H_ */ #endif /* CFMUXL_H_ */
...@@ -16,12 +16,6 @@ struct cfpkt; ...@@ -16,12 +16,6 @@ struct cfpkt;
*/ */
struct cfpkt *cfpkt_create(u16 len); struct cfpkt *cfpkt_create(u16 len);
/* Create a CAIF packet.
* data Data to copy.
* len Length of packet to be created
* @return New packet.
*/
struct cfpkt *cfpkt_create_uplink(const unsigned char *data, unsigned int len);
/* /*
* Destroy a CAIF Packet. * Destroy a CAIF Packet.
* pkt Packet to be destoyed. * pkt Packet to be destoyed.
...@@ -181,22 +175,6 @@ u16 cfpkt_iterate(struct cfpkt *pkt, ...@@ -181,22 +175,6 @@ u16 cfpkt_iterate(struct cfpkt *pkt,
u16 (*iter_func)(u16 chks, void *buf, u16 len), u16 (*iter_func)(u16 chks, void *buf, u16 len),
u16 data); u16 data);
/* Append by giving user access to packet buffer
* cfpkt Packet to append to
* buf Buffer inside pkt that user shall copy data into
* buflen Length of buffer and number of bytes added to packet
* @return 0 on error, 1 on success
*/
int cfpkt_raw_append(struct cfpkt *cfpkt, void **buf, unsigned int buflen);
/* Extract by giving user access to packet buffer
* cfpkt Packet to extract from
* buf Buffer inside pkt that user shall copy data from
* buflen Length of buffer and number of bytes removed from packet
* @return 0 on error, 1 on success
*/
int cfpkt_raw_extract(struct cfpkt *cfpkt, void **buf, unsigned int buflen);
/* Map from a "native" packet (e.g. Linux Socket Buffer) to a CAIF packet. /* Map from a "native" packet (e.g. Linux Socket Buffer) to a CAIF packet.
* dir - Direction indicating whether this packet is to be sent or received. * dir - Direction indicating whether this packet is to be sent or received.
* nativepkt - The native packet to be transformed to a CAIF packet * nativepkt - The native packet to be transformed to a CAIF packet
...@@ -210,59 +188,6 @@ struct cfpkt *cfpkt_fromnative(enum caif_direction dir, void *nativepkt); ...@@ -210,59 +188,6 @@ struct cfpkt *cfpkt_fromnative(enum caif_direction dir, void *nativepkt);
*/ */
void *cfpkt_tonative(struct cfpkt *pkt); void *cfpkt_tonative(struct cfpkt *pkt);
/*
* Insert a packet in the packet queue.
* pktq Packet queue to insert into
* pkt Packet to be inserted in queue
* prio Priority of packet
*/
void cfpkt_queue(struct cfpktq *pktq, struct cfpkt *pkt,
unsigned short prio);
/*
* Remove a packet from the packet queue.
* pktq Packet queue to fetch packets from.
* @return Dequeued packet.
*/
struct cfpkt *cfpkt_dequeue(struct cfpktq *pktq);
/*
* Peek into a packet from the packet queue.
* pktq Packet queue to fetch packets from.
* @return Peeked packet.
*/
struct cfpkt *cfpkt_qpeek(struct cfpktq *pktq);
/*
* Initiates the packet queue.
* @return Pointer to new packet queue.
*/
struct cfpktq *cfpktq_create(void);
/*
* Get the number of packets in the queue.
* pktq Packet queue to fetch count from.
* @return Number of packets in queue.
*/
int cfpkt_qcount(struct cfpktq *pktq);
/*
* Put content of packet into buffer for debuging purposes.
* pkt Packet to copy data from
* buf Buffer to copy data into
* buflen Length of data to copy
* @return Pointer to copied data
*/
char *cfpkt_log_pkt(struct cfpkt *pkt, char *buf, int buflen);
/*
* Clones a packet and releases the original packet.
* This is used for taking ownership of a packet e.g queueing.
* pkt Packet to clone and release.
* @return Cloned packet.
*/
struct cfpkt *cfpkt_clone_release(struct cfpkt *pkt);
/* /*
* Returns packet information for a packet. * Returns packet information for a packet.
......
...@@ -22,7 +22,6 @@ struct cfsrvl { ...@@ -22,7 +22,6 @@ struct cfsrvl {
struct kref ref; struct kref ref;
}; };
void cfsrvl_release(struct kref *kref);
struct cflayer *cfvei_create(u8 linkid, struct dev_info *dev_info); struct cflayer *cfvei_create(u8 linkid, struct dev_info *dev_info);
struct cflayer *cfdgml_create(u8 linkid, struct dev_info *dev_info); struct cflayer *cfdgml_create(u8 linkid, struct dev_info *dev_info);
struct cflayer *cfutill_create(u8 linkid, struct dev_info *dev_info); struct cflayer *cfutill_create(u8 linkid, struct dev_info *dev_info);
...@@ -31,7 +30,7 @@ struct cflayer *cfrfml_create(u8 linkid, struct dev_info *dev_info, ...@@ -31,7 +30,7 @@ struct cflayer *cfrfml_create(u8 linkid, struct dev_info *dev_info,
int mtu_size); int mtu_size);
struct cflayer *cfdbgl_create(u8 linkid, struct dev_info *dev_info); struct cflayer *cfdbgl_create(u8 linkid, struct dev_info *dev_info);
bool cfsrvl_phyid_match(struct cflayer *layer, int phyid); bool cfsrvl_phyid_match(struct cflayer *layer, int phyid);
void cfservl_destroy(struct cflayer *layer);
void cfsrvl_init(struct cfsrvl *service, void cfsrvl_init(struct cfsrvl *service,
u8 channel_id, u8 channel_id,
struct dev_info *dev_info, struct dev_info *dev_info,
......
...@@ -10,9 +10,9 @@ ...@@ -10,9 +10,9 @@
#include <net/caif/cfcnfg.h> #include <net/caif/cfcnfg.h>
#include <net/caif/caif_dev.h> #include <net/caif/caif_dev.h>
int connect_req_to_link_param(struct cfcnfg *cnfg, int caif_connect_req_to_link_param(struct cfcnfg *cnfg,
struct caif_connect_request *s, struct caif_connect_request *s,
struct cfctrl_link_param *l) struct cfctrl_link_param *l)
{ {
struct dev_info *dev_info; struct dev_info *dev_info;
enum cfcnfg_phy_preference pref; enum cfcnfg_phy_preference pref;
......
...@@ -257,7 +257,7 @@ static int caif_device_notify(struct notifier_block *me, unsigned long what, ...@@ -257,7 +257,7 @@ static int caif_device_notify(struct notifier_block *me, unsigned long what,
break; break;
} }
dev_hold(dev); dev_hold(dev);
cfcnfg_add_phy_layer(get_caif_conf(), cfcnfg_add_phy_layer(cfg,
phy_type, phy_type,
dev, dev,
&caifd->layer, &caifd->layer,
...@@ -300,7 +300,7 @@ static int caif_device_notify(struct notifier_block *me, unsigned long what, ...@@ -300,7 +300,7 @@ static int caif_device_notify(struct notifier_block *me, unsigned long what,
if (atomic_read(&caifd->in_use)) if (atomic_read(&caifd->in_use))
netdev_warn(dev, netdev_warn(dev,
"Unregistering an active CAIF device\n"); "Unregistering an active CAIF device\n");
cfcnfg_del_phy_layer(get_caif_conf(), &caifd->layer); cfcnfg_del_phy_layer(cfg, &caifd->layer);
dev_put(dev); dev_put(dev);
atomic_set(&caifd->state, what); atomic_set(&caifd->state, what);
break; break;
...@@ -322,24 +322,18 @@ static struct notifier_block caif_device_notifier = { ...@@ -322,24 +322,18 @@ static struct notifier_block caif_device_notifier = {
.priority = 0, .priority = 0,
}; };
struct cfcnfg *get_caif_conf(void)
{
return cfg;
}
EXPORT_SYMBOL(get_caif_conf);
int caif_connect_client(struct caif_connect_request *conn_req, int caif_connect_client(struct caif_connect_request *conn_req,
struct cflayer *client_layer, int *ifindex, struct cflayer *client_layer, int *ifindex,
int *headroom, int *tailroom) int *headroom, int *tailroom)
{ {
struct cfctrl_link_param param; struct cfctrl_link_param param;
int ret; int ret;
ret = connect_req_to_link_param(get_caif_conf(), conn_req, &param);
ret = caif_connect_req_to_link_param(cfg, conn_req, &param);
if (ret) if (ret)
return ret; return ret;
/* Hook up the adaptation layer. */ /* Hook up the adaptation layer. */
return cfcnfg_add_adaptation_layer(get_caif_conf(), &param, return cfcnfg_add_adaptation_layer(cfg, &param,
client_layer, ifindex, client_layer, ifindex,
headroom, tailroom); headroom, tailroom);
} }
...@@ -347,16 +341,10 @@ EXPORT_SYMBOL(caif_connect_client); ...@@ -347,16 +341,10 @@ EXPORT_SYMBOL(caif_connect_client);
int caif_disconnect_client(struct cflayer *adap_layer) int caif_disconnect_client(struct cflayer *adap_layer)
{ {
return cfcnfg_disconn_adapt_layer(get_caif_conf(), adap_layer); return cfcnfg_disconn_adapt_layer(cfg, adap_layer);
} }
EXPORT_SYMBOL(caif_disconnect_client); EXPORT_SYMBOL(caif_disconnect_client);
void caif_release_client(struct cflayer *adap_layer)
{
cfcnfg_release_adap_layer(adap_layer);
}
EXPORT_SYMBOL(caif_release_client);
/* Per-namespace Caif devices handling */ /* Per-namespace Caif devices handling */
static int caif_init_net(struct net *net) static int caif_init_net(struct net *net)
{ {
......
...@@ -253,7 +253,7 @@ static void cfcnfg_linkdestroy_rsp(struct cflayer *layer, u8 channel_id) ...@@ -253,7 +253,7 @@ static void cfcnfg_linkdestroy_rsp(struct cflayer *layer, u8 channel_id)
{ {
} }
int protohead[CFCTRL_SRV_MASK] = { static const int protohead[CFCTRL_SRV_MASK] = {
[CFCTRL_SRV_VEI] = 4, [CFCTRL_SRV_VEI] = 4,
[CFCTRL_SRV_DATAGRAM] = 7, [CFCTRL_SRV_DATAGRAM] = 7,
[CFCTRL_SRV_UTIL] = 4, [CFCTRL_SRV_UTIL] = 4,
......
...@@ -58,7 +58,8 @@ struct cflayer *cfctrl_create(void) ...@@ -58,7 +58,8 @@ struct cflayer *cfctrl_create(void)
return &this->serv.layer; return &this->serv.layer;
} }
static bool param_eq(struct cfctrl_link_param *p1, struct cfctrl_link_param *p2) static bool param_eq(const struct cfctrl_link_param *p1,
const struct cfctrl_link_param *p2)
{ {
bool eq = bool eq =
p1->linktype == p2->linktype && p1->linktype == p2->linktype &&
...@@ -100,8 +101,8 @@ static bool param_eq(struct cfctrl_link_param *p1, struct cfctrl_link_param *p2) ...@@ -100,8 +101,8 @@ static bool param_eq(struct cfctrl_link_param *p1, struct cfctrl_link_param *p2)
return false; return false;
} }
bool cfctrl_req_eq(struct cfctrl_request_info *r1, static bool cfctrl_req_eq(const struct cfctrl_request_info *r1,
struct cfctrl_request_info *r2) const struct cfctrl_request_info *r2)
{ {
if (r1->cmd != r2->cmd) if (r1->cmd != r2->cmd)
return false; return false;
...@@ -112,7 +113,7 @@ bool cfctrl_req_eq(struct cfctrl_request_info *r1, ...@@ -112,7 +113,7 @@ bool cfctrl_req_eq(struct cfctrl_request_info *r1,
} }
/* Insert request at the end */ /* Insert request at the end */
void cfctrl_insert_req(struct cfctrl *ctrl, static void cfctrl_insert_req(struct cfctrl *ctrl,
struct cfctrl_request_info *req) struct cfctrl_request_info *req)
{ {
spin_lock(&ctrl->info_list_lock); spin_lock(&ctrl->info_list_lock);
...@@ -123,8 +124,8 @@ void cfctrl_insert_req(struct cfctrl *ctrl, ...@@ -123,8 +124,8 @@ void cfctrl_insert_req(struct cfctrl *ctrl,
} }
/* Compare and remove request */ /* Compare and remove request */
struct cfctrl_request_info *cfctrl_remove_req(struct cfctrl *ctrl, static struct cfctrl_request_info *cfctrl_remove_req(struct cfctrl *ctrl,
struct cfctrl_request_info *req) struct cfctrl_request_info *req)
{ {
struct cfctrl_request_info *p, *tmp, *first; struct cfctrl_request_info *p, *tmp, *first;
...@@ -154,16 +155,6 @@ struct cfctrl_rsp *cfctrl_get_respfuncs(struct cflayer *layer) ...@@ -154,16 +155,6 @@ struct cfctrl_rsp *cfctrl_get_respfuncs(struct cflayer *layer)
return &this->res; return &this->res;
} }
void cfctrl_set_dnlayer(struct cflayer *this, struct cflayer *dn)
{
this->dn = dn;
}
void cfctrl_set_uplayer(struct cflayer *this, struct cflayer *up)
{
this->up = up;
}
static void init_info(struct caif_payload_info *info, struct cfctrl *cfctrl) static void init_info(struct caif_payload_info *info, struct cfctrl *cfctrl)
{ {
info->hdr_len = 0; info->hdr_len = 0;
...@@ -304,58 +295,6 @@ int cfctrl_linkdown_req(struct cflayer *layer, u8 channelid, ...@@ -304,58 +295,6 @@ int cfctrl_linkdown_req(struct cflayer *layer, u8 channelid,
return ret; return ret;
} }
void cfctrl_sleep_req(struct cflayer *layer)
{
int ret;
struct cfctrl *cfctrl = container_obj(layer);
struct cfpkt *pkt = cfpkt_create(CFPKT_CTRL_PKT_LEN);
if (!pkt) {
pr_warn("Out of memory\n");
return;
}
cfpkt_addbdy(pkt, CFCTRL_CMD_SLEEP);
init_info(cfpkt_info(pkt), cfctrl);
ret =
cfctrl->serv.layer.dn->transmit(cfctrl->serv.layer.dn, pkt);
if (ret < 0)
cfpkt_destroy(pkt);
}
void cfctrl_wake_req(struct cflayer *layer)
{
int ret;
struct cfctrl *cfctrl = container_obj(layer);
struct cfpkt *pkt = cfpkt_create(CFPKT_CTRL_PKT_LEN);
if (!pkt) {
pr_warn("Out of memory\n");
return;
}
cfpkt_addbdy(pkt, CFCTRL_CMD_WAKE);
init_info(cfpkt_info(pkt), cfctrl);
ret =
cfctrl->serv.layer.dn->transmit(cfctrl->serv.layer.dn, pkt);
if (ret < 0)
cfpkt_destroy(pkt);
}
void cfctrl_getstartreason_req(struct cflayer *layer)
{
int ret;
struct cfctrl *cfctrl = container_obj(layer);
struct cfpkt *pkt = cfpkt_create(CFPKT_CTRL_PKT_LEN);
if (!pkt) {
pr_warn("Out of memory\n");
return;
}
cfpkt_addbdy(pkt, CFCTRL_CMD_START_REASON);
init_info(cfpkt_info(pkt), cfctrl);
ret =
cfctrl->serv.layer.dn->transmit(cfctrl->serv.layer.dn, pkt);
if (ret < 0)
cfpkt_destroy(pkt);
}
void cfctrl_cancel_req(struct cflayer *layr, struct cflayer *adap_layer) void cfctrl_cancel_req(struct cflayer *layr, struct cflayer *adap_layer)
{ {
struct cfctrl_request_info *p, *tmp; struct cfctrl_request_info *p, *tmp;
......
...@@ -71,41 +71,6 @@ int cfmuxl_set_uplayer(struct cflayer *layr, struct cflayer *up, u8 linkid) ...@@ -71,41 +71,6 @@ int cfmuxl_set_uplayer(struct cflayer *layr, struct cflayer *up, u8 linkid)
return 0; return 0;
} }
bool cfmuxl_is_phy_inuse(struct cflayer *layr, u8 phyid)
{
struct list_head *node;
struct cflayer *layer;
struct cfmuxl *muxl = container_obj(layr);
bool match = false;
spin_lock(&muxl->receive_lock);
list_for_each(node, &muxl->srvl_list) {
layer = list_entry(node, struct cflayer, node);
if (cfsrvl_phyid_match(layer, phyid)) {
match = true;
break;
}
}
spin_unlock(&muxl->receive_lock);
return match;
}
u8 cfmuxl_get_phyid(struct cflayer *layr, u8 channel_id)
{
struct cflayer *up;
int phyid;
struct cfmuxl *muxl = container_obj(layr);
spin_lock(&muxl->receive_lock);
up = get_up(muxl, channel_id);
if (up != NULL)
phyid = cfsrvl_getphyid(up);
else
phyid = 0;
spin_unlock(&muxl->receive_lock);
return phyid;
}
int cfmuxl_set_dnlayer(struct cflayer *layr, struct cflayer *dn, u8 phyid) int cfmuxl_set_dnlayer(struct cflayer *layr, struct cflayer *dn, u8 phyid)
{ {
struct cfmuxl *muxl = (struct cfmuxl *) layr; struct cfmuxl *muxl = (struct cfmuxl *) layr;
......
...@@ -42,22 +42,22 @@ struct cfpkt_priv_data { ...@@ -42,22 +42,22 @@ struct cfpkt_priv_data {
bool erronous; bool erronous;
}; };
inline struct cfpkt_priv_data *cfpkt_priv(struct cfpkt *pkt) static inline struct cfpkt_priv_data *cfpkt_priv(struct cfpkt *pkt)
{ {
return (struct cfpkt_priv_data *) pkt->skb.cb; return (struct cfpkt_priv_data *) pkt->skb.cb;
} }
inline bool is_erronous(struct cfpkt *pkt) static inline bool is_erronous(struct cfpkt *pkt)
{ {
return cfpkt_priv(pkt)->erronous; return cfpkt_priv(pkt)->erronous;
} }
inline struct sk_buff *pkt_to_skb(struct cfpkt *pkt) static inline struct sk_buff *pkt_to_skb(struct cfpkt *pkt)
{ {
return &pkt->skb; return &pkt->skb;
} }
inline struct cfpkt *skb_to_pkt(struct sk_buff *skb) static inline struct cfpkt *skb_to_pkt(struct sk_buff *skb)
{ {
return (struct cfpkt *) skb; return (struct cfpkt *) skb;
} }
...@@ -317,17 +317,6 @@ int cfpkt_setlen(struct cfpkt *pkt, u16 len) ...@@ -317,17 +317,6 @@ int cfpkt_setlen(struct cfpkt *pkt, u16 len)
} }
EXPORT_SYMBOL(cfpkt_setlen); EXPORT_SYMBOL(cfpkt_setlen);
struct cfpkt *cfpkt_create_uplink(const unsigned char *data, unsigned int len)
{
struct cfpkt *pkt = cfpkt_create_pfx(len + PKT_POSTFIX, PKT_PREFIX);
if (!pkt)
return NULL;
if (unlikely(data != NULL))
cfpkt_add_body(pkt, data, len);
return pkt;
}
EXPORT_SYMBOL(cfpkt_create_uplink);
struct cfpkt *cfpkt_append(struct cfpkt *dstpkt, struct cfpkt *cfpkt_append(struct cfpkt *dstpkt,
struct cfpkt *addpkt, struct cfpkt *addpkt,
u16 expectlen) u16 expectlen)
...@@ -408,169 +397,12 @@ struct cfpkt *cfpkt_split(struct cfpkt *pkt, u16 pos) ...@@ -408,169 +397,12 @@ struct cfpkt *cfpkt_split(struct cfpkt *pkt, u16 pos)
} }
EXPORT_SYMBOL(cfpkt_split); EXPORT_SYMBOL(cfpkt_split);
char *cfpkt_log_pkt(struct cfpkt *pkt, char *buf, int buflen) bool cfpkt_erroneous(struct cfpkt *pkt)
{
struct sk_buff *skb = pkt_to_skb(pkt);
char *p = buf;
int i;
/*
* Sanity check buffer length, it needs to be at least as large as
* the header info: ~=50+ bytes
*/
if (buflen < 50)
return NULL;
snprintf(buf, buflen, "%s: pkt:%p len:%ld(%ld+%ld) {%ld,%ld} data: [",
is_erronous(pkt) ? "ERRONOUS-SKB" :
(skb->data_len != 0 ? "COMPLEX-SKB" : "SKB"),
skb,
(long) skb->len,
(long) (skb_tail_pointer(skb) - skb->data),
(long) skb->data_len,
(long) (skb->data - skb->head),
(long) (skb_tail_pointer(skb) - skb->head));
p = buf + strlen(buf);
for (i = 0; i < skb_tail_pointer(skb) - skb->data && i < 300; i++) {
if (p > buf + buflen - 10) {
sprintf(p, "...");
p = buf + strlen(buf);
break;
}
sprintf(p, "%02x,", skb->data[i]);
p = buf + strlen(buf);
}
sprintf(p, "]\n");
return buf;
}
EXPORT_SYMBOL(cfpkt_log_pkt);
int cfpkt_raw_append(struct cfpkt *pkt, void **buf, unsigned int buflen)
{
struct sk_buff *skb = pkt_to_skb(pkt);
struct sk_buff *lastskb;
caif_assert(buf != NULL);
if (unlikely(is_erronous(pkt)))
return -EPROTO;
/* Make sure SKB is writable */
if (unlikely(skb_cow_data(skb, 0, &lastskb) < 0)) {
PKT_ERROR(pkt, "skb_cow_data failed\n");
return -EPROTO;
}
if (unlikely(skb_linearize(skb) != 0)) {
PKT_ERROR(pkt, "linearize failed\n");
return -EPROTO;
}
if (unlikely(skb_tailroom(skb) < buflen)) {
PKT_ERROR(pkt, "buffer too short - failed\n");
return -EPROTO;
}
*buf = skb_put(skb, buflen);
return 1;
}
EXPORT_SYMBOL(cfpkt_raw_append);
int cfpkt_raw_extract(struct cfpkt *pkt, void **buf, unsigned int buflen)
{
struct sk_buff *skb = pkt_to_skb(pkt);
caif_assert(buf != NULL);
if (unlikely(is_erronous(pkt)))
return -EPROTO;
if (unlikely(buflen > skb->len)) {
PKT_ERROR(pkt, "buflen too large - failed\n");
return -EPROTO;
}
if (unlikely(buflen > skb_headlen(skb))) {
if (unlikely(skb_linearize(skb) != 0)) {
PKT_ERROR(pkt, "linearize failed\n");
return -EPROTO;
}
}
*buf = skb->data;
skb_pull(skb, buflen);
return 1;
}
EXPORT_SYMBOL(cfpkt_raw_extract);
inline bool cfpkt_erroneous(struct cfpkt *pkt)
{ {
return cfpkt_priv(pkt)->erronous; return cfpkt_priv(pkt)->erronous;
} }
EXPORT_SYMBOL(cfpkt_erroneous); EXPORT_SYMBOL(cfpkt_erroneous);
struct cfpktq *cfpktq_create(void)
{
struct cfpktq *q = kmalloc(sizeof(struct cfpktq), GFP_ATOMIC);
if (!q)
return NULL;
skb_queue_head_init(&q->head);
atomic_set(&q->count, 0);
spin_lock_init(&q->lock);
return q;
}
EXPORT_SYMBOL(cfpktq_create);
void cfpkt_queue(struct cfpktq *pktq, struct cfpkt *pkt, unsigned short prio)
{
atomic_inc(&pktq->count);
spin_lock(&pktq->lock);
skb_queue_tail(&pktq->head, pkt_to_skb(pkt));
spin_unlock(&pktq->lock);
}
EXPORT_SYMBOL(cfpkt_queue);
struct cfpkt *cfpkt_qpeek(struct cfpktq *pktq)
{
struct cfpkt *tmp;
spin_lock(&pktq->lock);
tmp = skb_to_pkt(skb_peek(&pktq->head));
spin_unlock(&pktq->lock);
return tmp;
}
EXPORT_SYMBOL(cfpkt_qpeek);
struct cfpkt *cfpkt_dequeue(struct cfpktq *pktq)
{
struct cfpkt *pkt;
spin_lock(&pktq->lock);
pkt = skb_to_pkt(skb_dequeue(&pktq->head));
if (pkt) {
atomic_dec(&pktq->count);
caif_assert(atomic_read(&pktq->count) >= 0);
}
spin_unlock(&pktq->lock);
return pkt;
}
EXPORT_SYMBOL(cfpkt_dequeue);
int cfpkt_qcount(struct cfpktq *pktq)
{
return atomic_read(&pktq->count);
}
EXPORT_SYMBOL(cfpkt_qcount);
struct cfpkt *cfpkt_clone_release(struct cfpkt *pkt)
{
struct cfpkt *clone;
clone = skb_to_pkt(skb_clone(pkt_to_skb(pkt), GFP_ATOMIC));
/* Free original packet. */
cfpkt_destroy(pkt);
if (!clone)
return NULL;
return clone;
}
EXPORT_SYMBOL(cfpkt_clone_release);
struct caif_payload_info *cfpkt_info(struct cfpkt *pkt) struct caif_payload_info *cfpkt_info(struct cfpkt *pkt)
{ {
......
...@@ -151,12 +151,7 @@ static int cfservl_modemcmd(struct cflayer *layr, enum caif_modemcmd ctrl) ...@@ -151,12 +151,7 @@ static int cfservl_modemcmd(struct cflayer *layr, enum caif_modemcmd ctrl)
return -EINVAL; return -EINVAL;
} }
void cfservl_destroy(struct cflayer *layer) static void cfsrvl_release(struct kref *kref)
{
kfree(layer);
}
void cfsrvl_release(struct kref *kref)
{ {
struct cfsrvl *service = container_of(kref, struct cfsrvl, ref); struct cfsrvl *service = container_of(kref, struct cfsrvl, ref);
kfree(service); kfree(service);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment