/* invoked when a name service announcement arrives */
static void rpmsg_ns_cb(struct rpmsg_channel *rpdev, void *data, int len,
void *priv, u32 src)
{
struct rpmsg_ns_msg *msg = data;
struct rpmsg_channel *newch;
struct rpmsg_channel_info chinfo;
struct virtproc_info *vrp = priv;
struct device *dev = &vrp->vdev->dev;
int ret;
#if 0
print_hex_dump(KERN_DEBUG, "NS announcement: ",
DUMP_PREFIX_NONE, 16, 1,
data, len, true);
#endif
if (len != sizeof(*msg)) {
dev_err(dev, "malformed ns msg (%d)\n", len);
return;
}
/*
* the name service ept does _not_ belong to a real rpmsg channel,
* and is handled by the rpmsg bus itself.
* for sanity reasons, make sure a valid rpdev has _not_ sneaked
* in somehow.
*/
if (rpdev) {
dev_err(dev, "anomaly: ns ept has an rpdev handle\n");
return;
}
/* don't trust the remote processor for null terminating the name */
msg->name[RPMSG_NAME_SIZE - 1] = '\0';
dev_info(dev, "%sing channel %s addr 0x%x\n",
msg->flags & RPMSG_NS_DESTROY ? "destroy" : "creat",
msg->name, msg->addr);
strncpy(chinfo.name, msg->name, sizeof(chinfo.name));
chinfo.src = RPMSG_ADDR_ANY;
chinfo.dst = msg->addr;
if (msg->flags & RPMSG_NS_DESTROY) {
ret = __rpmsg_destroy_channel(vrp, &chinfo);
if (ret)
dev_err(dev, "__rpmsg_destroy_channel err: %d\n", ret);
} else {
newch = __rpmsg_create_channel(vrp, &chinfo);
if (!newch)
dev_err(dev, "__rpmsg_create_channel failed\n");
}
}
struct rpmsg_channel *rpmsg_create_channel(int vrp_id, const char *name,
int src, int dst)
{
struct rpmsg_channel_info chinfo;
struct virtproc_info *vrp;
strncpy(chinfo.name, name, sizeof(chinfo.name));
chinfo.src = src;
chinfo.dst = dst;
/* TODO we probably want radix tree and fw-induced id numbers ? */
vrp = idr_find(&vprocs, vrp_id);
if (!vrp)
return NULL;
return __rpmsg_create_channel(vrp, &chinfo);
}