drivers/rpmsg/rpmsg_core.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * remote processor messaging bus
   4  *
   5  * Copyright (C) 2011 Texas Instruments, Inc.
   6  * Copyright (C) 2011 Google, Inc.
   7  *
   8  * Ohad Ben-Cohen <[email protected]>
   9  * Brian Swetland <[email protected]>
  10  */
  11
  12 #define pr_fmt(fmt) "%s: " fmt, __func__
  13
  14 #include <linux/kernel.h>
  15 #include <linux/module.h>
  16 #include <linux/rpmsg.h>
  17 #include <linux/of_device.h>
  18 #include <linux/pm_domain.h>
  19 #include <linux/slab.h>
  20
  21 #include "rpmsg_internal.h"
  22
  23 const struct class rpmsg_class = {
  24         .name = "rpmsg",
  25 };
  26 EXPORT_SYMBOL(rpmsg_class);
  27
  28 /**
  29  * rpmsg_create_channel() - create a new rpmsg channel
  30  * using its name and address info.
  31  * @rpdev: rpmsg device
  32  * @chinfo: channel_info to bind
  33  *
  34  * Return: a pointer to the new rpmsg device on success, or NULL on error.
  35  */
  36 struct rpmsg_device *rpmsg_create_channel(struct rpmsg_device *rpdev,
  37                                           struct rpmsg_channel_info *chinfo)
  38 {
  39         if (WARN_ON(!rpdev))
  40                 return NULL;
  41         if (!rpdev->ops || !rpdev->ops->create_channel) {
  42                 dev_err(&rpdev->dev, "no create_channel ops found\n");
  43                 return NULL;
  44         }
  45
  46         return rpdev->ops->create_channel(rpdev, chinfo);
  47 }
  48 EXPORT_SYMBOL(rpmsg_create_channel);
  49
  50 /**
  51  * rpmsg_release_channel() - release a rpmsg channel
  52  * using its name and address info.
  53  * @rpdev: rpmsg device
  54  * @chinfo: channel_info to bind
  55  *
  56  * Return: 0 on success or an appropriate error value.
  57  */
  58 int rpmsg_release_channel(struct rpmsg_device *rpdev,
  59                           struct rpmsg_channel_info *chinfo)
  60 {
  61         if (WARN_ON(!rpdev))
  62                 return -EINVAL;
  63         if (!rpdev->ops || !rpdev->ops->release_channel) {
  64                 dev_err(&rpdev->dev, "no release_channel ops found\n");
  65                 return -ENXIO;
  66         }
  67
  68         return rpdev->ops->release_channel(rpdev, chinfo);
  69 }
  70 EXPORT_SYMBOL(rpmsg_release_channel);
  71
  72 /**
  73  * rpmsg_create_ept() - create a new rpmsg_endpoint
  74  * @rpdev: rpmsg channel device
  75  * @cb: rx callback handler
  76  * @priv: private data for the driver's use
  77  * @chinfo: channel_info with the local rpmsg address to bind with @cb
  78  *
  79  * Every rpmsg address in the system is bound to an rx callback (so when
  80  * inbound messages arrive, they are dispatched by the rpmsg bus using the
  81  * appropriate callback handler) by means of an rpmsg_endpoint struct.
  82  *
  83  * This function allows drivers to create such an endpoint, and by that,
  84  * bind a callback, and possibly some private data too, to an rpmsg address
  85  * (either one that is known in advance, or one that will be dynamically
  86  * assigned for them).
  87  *
  88  * Simple rpmsg drivers need not call rpmsg_create_ept, because an endpoint
  89  * is already created for them when they are probed by the rpmsg bus
  90  * (using the rx callback provided when they registered to the rpmsg bus).
  91  *
  92  * So things should just work for simple drivers: they already have an
  93  * endpoint, their rx callback is bound to their rpmsg address, and when
  94  * relevant inbound messages arrive (i.e. messages which their dst address
  95  * equals to the src address of their rpmsg channel), the driver's handler
  96  * is invoked to process it.
  97  *
  98  * That said, more complicated drivers might need to allocate
  99  * additional rpmsg addresses, and bind them to different rx callbacks.
 100  * To accomplish that, those drivers need to call this function.
 101  *
 102  * Drivers should provide their @rpdev channel (so the new endpoint would belong
 103  * to the same remote processor their channel belongs to), an rx callback
 104  * function, an optional private data (which is provided back when the
 105  * rx callback is invoked), and an address they want to bind with the
 106  * callback. If @addr is RPMSG_ADDR_ANY, then rpmsg_create_ept will
 107  * dynamically assign them an available rpmsg address (drivers should have
 108  * a very good reason why not to always use RPMSG_ADDR_ANY here).
 109  *
 110  * Return: a pointer to the endpoint on success, or NULL on error.
 111  */
 112 struct rpmsg_endpoint *rpmsg_create_ept(struct rpmsg_device *rpdev,
 113                                         rpmsg_rx_cb_t cb, void *priv,
 114                                         struct rpmsg_channel_info chinfo)
 115 {
 116         if (WARN_ON(!rpdev))
 117                 return NULL;
 118
 119         return rpdev->ops->create_ept(rpdev, cb, priv, chinfo);
 120 }
 121 EXPORT_SYMBOL(rpmsg_create_ept);
 122
 123 /**
 124  * rpmsg_destroy_ept() - destroy an existing rpmsg endpoint
 125  * @ept: endpoing to destroy
 126  *
 127  * Should be used by drivers to destroy an rpmsg endpoint previously
 128  * created with rpmsg_create_ept(). As with other types of "free" NULL
 129  * is a valid parameter.
 130  */
 131 void rpmsg_destroy_ept(struct rpmsg_endpoint *ept)
 132 {
 133         if (ept && ept->ops)
 134                 ept->ops->destroy_ept(ept);
 135 }
 136 EXPORT_SYMBOL(rpmsg_destroy_ept);
 137
 138 /**
 139  * rpmsg_send() - send a message across to the remote processor
 140  * @ept: the rpmsg endpoint
 141  * @data: payload of message
 142  * @len: length of payload
 143  *
 144  * This function sends @data of length @len on the @ept endpoint.
 145  * The message will be sent to the remote processor which the @ept
 146  * endpoint belongs to, using @ept's address and its associated rpmsg
 147  * device destination addresses.
 148  * In case there are no TX buffers available, the function will block until
 149  * one becomes available, or a timeout of 15 seconds elapses. When the latter
 150  * happens, -ERESTARTSYS is returned.
 151  *
 152  * Can only be called from process context (for now).
 153  *
 154  * Return: 0 on success and an appropriate error value on failure.
 155  */
 156 int rpmsg_send(struct rpmsg_endpoint *ept, void *data, int len)
 157 {
 158         if (WARN_ON(!ept))
 159                 return -EINVAL;
 160         if (!ept->ops->send)
 161                 return -ENXIO;
 162
 163         return ept->ops->send(ept, data, len);
 164 }
 165 EXPORT_SYMBOL(rpmsg_send);
 166
 167 /**
 168  * rpmsg_sendto() - send a message across to the remote processor, specify dst
 169  * @ept: the rpmsg endpoint
 170  * @data: payload of message
 171  * @len: length of payload
 172  * @dst: destination address
 173  *
 174  * This function sends @data of length @len to the remote @dst address.
 175  * The message will be sent to the remote processor which the @ept
 176  * endpoint belongs to, using @ept's address as source.
 177  * In case there are no TX buffers available, the function will block until
 178  * one becomes available, or a timeout of 15 seconds elapses. When the latter
 179  * happens, -ERESTARTSYS is returned.
 180  *
 181  * Can only be called from process context (for now).
 182  *
 183  * Return: 0 on success and an appropriate error value on failure.
 184  */
 185 int rpmsg_sendto(struct rpmsg_endpoint *ept, void *data, int len, u32 dst)
 186 {
 187         if (WARN_ON(!ept))
 188                 return -EINVAL;
 189         if (!ept->ops->sendto)
 190                 return -ENXIO;
 191
 192         return ept->ops->sendto(ept, data, len, dst);
 193 }
 194 EXPORT_SYMBOL(rpmsg_sendto);
 195
 196 /**
 197  * rpmsg_send_offchannel() - send a message using explicit src/dst addresses
 198  * @ept: the rpmsg endpoint
 199  * @src: source address
 200  * @dst: destination address
 201  * @data: payload of message
 202  * @len: length of payload
 203  *
 204  * This function sends @data of length @len to the remote @dst address,
 205  * and uses @src as the source address.
 206  * The message will be sent to the remote processor which the @ept
 207  * endpoint belongs to.
 208  * In case there are no TX buffers available, the function will block until
 209  * one becomes available, or a timeout of 15 seconds elapses. When the latter
 210  * happens, -ERESTARTSYS is returned.
 211  *
 212  * Can only be called from process context (for now).
 213  *
 214  * Return: 0 on success and an appropriate error value on failure.
 215  */
 216 int rpmsg_send_offchannel(struct rpmsg_endpoint *ept, u32 src, u32 dst,
 217                           void *data, int len)
 218 {
 219         if (WARN_ON(!ept))
 220                 return -EINVAL;
 221         if (!ept->ops->send_offchannel)
 222                 return -ENXIO;
 223
 224         return ept->ops->send_offchannel(ept, src, dst, data, len);
 225 }
 226 EXPORT_SYMBOL(rpmsg_send_offchannel);
 227
 228 /**
 229  * rpmsg_trysend() - send a message across to the remote processor
 230  * @ept: the rpmsg endpoint
 231  * @data: payload of message
 232  * @len: length of payload
 233  *
 234  * This function sends @data of length @len on the @ept endpoint.
 235  * The message will be sent to the remote processor which the @ept
 236  * endpoint belongs to, using @ept's address as source and its associated
 237  * rpdev's address as destination.
 238  * In case there are no TX buffers available, the function will immediately
 239  * return -ENOMEM without waiting until one becomes available.
 240  *
 241  * Can only be called from process context (for now).
 242  *
 243  * Return: 0 on success and an appropriate error value on failure.
 244  */
 245 int rpmsg_trysend(struct rpmsg_endpoint *ept, void *data, int len)
 246 {
 247         if (WARN_ON(!ept))
 248                 return -EINVAL;
 249         if (!ept->ops->trysend)
 250                 return -ENXIO;
 251
 252         return ept->ops->trysend(ept, data, len);
 253 }
 254 EXPORT_SYMBOL(rpmsg_trysend);
 255
 256 /**
 257  * rpmsg_trysendto() - send a message across to the remote processor, specify dst
 258  * @ept: the rpmsg endpoint
 259  * @data: payload of message
 260  * @len: length of payload
 261  * @dst: destination address
 262  *
 263  * This function sends @data of length @len to the remote @dst address.
 264  * The message will be sent to the remote processor which the @ept
 265  * endpoint belongs to, using @ept's address as source.
 266  * In case there are no TX buffers available, the function will immediately
 267  * return -ENOMEM without waiting until one becomes available.
 268  *
 269  * Can only be called from process context (for now).
 270  *
 271  * Return: 0 on success and an appropriate error value on failure.
 272  */
 273 int rpmsg_trysendto(struct rpmsg_endpoint *ept, void *data, int len, u32 dst)
 274 {
 275         if (WARN_ON(!ept))
 276                 return -EINVAL;
 277         if (!ept->ops->trysendto)
 278                 return -ENXIO;
 279
 280         return ept->ops->trysendto(ept, data, len, dst);
 281 }
 282 EXPORT_SYMBOL(rpmsg_trysendto);
 283
 284 /**
 285  * rpmsg_poll() - poll the endpoint's send buffers
 286  * @ept:        the rpmsg endpoint
 287  * @filp:       file for poll_wait()
 288  * @wait:       poll_table for poll_wait()
 289  *
 290  * Return: mask representing the current state of the endpoint's send buffers
 291  */
 292 __poll_t rpmsg_poll(struct rpmsg_endpoint *ept, struct file *filp,
 293                         poll_table *wait)
 294 {
 295         if (WARN_ON(!ept))
 296                 return 0;
 297         if (!ept->ops->poll)
 298                 return 0;
 299
 300         return ept->ops->poll(ept, filp, wait);
 301 }
 302 EXPORT_SYMBOL(rpmsg_poll);
 303
 304 /**
 305  * rpmsg_trysend_offchannel() - send a message using explicit src/dst addresses
 306  * @ept: the rpmsg endpoint
 307  * @src: source address
 308  * @dst: destination address
 309  * @data: payload of message
 310  * @len: length of payload
 311  *
 312  * This function sends @data of length @len to the remote @dst address,
 313  * and uses @src as the source address.
 314  * The message will be sent to the remote processor which the @ept
 315  * endpoint belongs to.
 316  * In case there are no TX buffers available, the function will immediately
 317  * return -ENOMEM without waiting until one becomes available.
 318  *
 319  * Can only be called from process context (for now).
 320  *
 321  * Return: 0 on success and an appropriate error value on failure.
 322  */
 323 int rpmsg_trysend_offchannel(struct rpmsg_endpoint *ept, u32 src, u32 dst,
 324                              void *data, int len)
 325 {
 326         if (WARN_ON(!ept))
 327                 return -EINVAL;
 328         if (!ept->ops->trysend_offchannel)
 329                 return -ENXIO;
 330
 331         return ept->ops->trysend_offchannel(ept, src, dst, data, len);
 332 }
 333 EXPORT_SYMBOL(rpmsg_trysend_offchannel);
 334
 335 /**
 336  * rpmsg_set_flow_control() - request remote to pause/resume transmission
 337  * @ept:        the rpmsg endpoint
 338  * @pause:      pause transmission
 339  * @dst:        destination address of the endpoint
 340  *
 341  * Return: 0 on success and an appropriate error value on failure.
 342  */
 343 int rpmsg_set_flow_control(struct rpmsg_endpoint *ept, bool pause, u32 dst)
 344 {
 345         if (WARN_ON(!ept))
 346                 return -EINVAL;
 347         if (!ept->ops->set_flow_control)
 348                 return -EOPNOTSUPP;
 349
 350         return ept->ops->set_flow_control(ept, pause, dst);
 351 }
 352 EXPORT_SYMBOL_GPL(rpmsg_set_flow_control);
 353
 354 /**
 355  * rpmsg_get_mtu() - get maximum transmission buffer size for sending message.
 356  * @ept: the rpmsg endpoint
 357  *
 358  * This function returns maximum buffer size available for a single outgoing message.
 359  *
 360  * Return: the maximum transmission size on success and an appropriate error
 361  * value on failure.
 362  */
 363
 364 ssize_t rpmsg_get_mtu(struct rpmsg_endpoint *ept)
 365 {
 366         if (WARN_ON(!ept))
 367                 return -EINVAL;
 368         if (!ept->ops->get_mtu)
 369                 return -ENOTSUPP;
 370
 371         return ept->ops->get_mtu(ept);
 372 }
 373 EXPORT_SYMBOL(rpmsg_get_mtu);
 374
 375 /*
 376  * match a rpmsg channel with a channel info struct.
 377  * this is used to make sure we're not creating rpmsg devices for channels
 378  * that already exist.
 379  */
 380 static int rpmsg_device_match(struct device *dev, void *data)
 381 {
 382         struct rpmsg_channel_info *chinfo = data;
 383         struct rpmsg_device *rpdev = to_rpmsg_device(dev);
 384
 385         if (chinfo->src != RPMSG_ADDR_ANY && chinfo->src != rpdev->src)
 386                 return 0;
 387
 388         if (chinfo->dst != RPMSG_ADDR_ANY && chinfo->dst != rpdev->dst)
 389                 return 0;
 390
 391         if (strncmp(chinfo->name, rpdev->id.name, RPMSG_NAME_SIZE))
 392                 return 0;
 393
 394         /* found a match ! */
 395         return 1;
 396 }
 397
 398 struct device *rpmsg_find_device(struct device *parent,
 399                                  struct rpmsg_channel_info *chinfo)
 400 {
 401         return device_find_child(parent, chinfo, rpmsg_device_match);
 402
 403 }
 404 EXPORT_SYMBOL(rpmsg_find_device);
 405
 406 /* sysfs show configuration fields */
 407 #define rpmsg_show_attr(field, path, format_string)                     \
 408 static ssize_t                                                          \
 409 field##_show(struct device *dev,                                        \
 410                         struct device_attribute *attr, char *buf)       \
 411 {                                                                       \
 412         struct rpmsg_device *rpdev = to_rpmsg_device(dev);              \
 413                                                                         \
 414         return sprintf(buf, format_string, rpdev->path);                \
 415 }                                                                       \
 416 static DEVICE_ATTR_RO(field);
 417
 418 #define rpmsg_string_attr(field, member)                                \
 419 static ssize_t                                                          \
 420 field##_store(struct device *dev, struct device_attribute *attr,        \
 421               const char *buf, size_t sz)                               \
 422 {                                                                       \
 423         struct rpmsg_device *rpdev = to_rpmsg_device(dev);              \
 424         const char *old;                                                \
 425         char *new;                                                      \
 426                                                                         \
 427         new = kstrndup(buf, sz, GFP_KERNEL);                            \
 428         if (!new)                                                       \
 429                 return -ENOMEM;                                         \
 430         new[strcspn(new, "\n")] = '\0';                                 \
 431                                                                         \
 432         device_lock(dev);                                               \
 433         old = rpdev->member;                                            \
 434         if (strlen(new)) {                                              \
 435                 rpdev->member = new;                                    \
 436         } else {                                                        \
 437                 kfree(new);                                             \
 438                 rpdev->member = NULL;                                   \
 439         }                                                               \
 440         device_unlock(dev);                                             \
 441                                                                         \
 442         kfree(old);                                                     \
 443                                                                         \
 444         return sz;                                                      \
 445 }                                                                       \
 446 static ssize_t                                                          \
 447 field##_show(struct device *dev,                                        \
 448              struct device_attribute *attr, char *buf)                  \
 449 {                                                                       \
 450         struct rpmsg_device *rpdev = to_rpmsg_device(dev);              \
 451                                                                         \
 452         return sprintf(buf, "%s\n", rpdev->member);                     \
 453 }                                                                       \
 454 static DEVICE_ATTR_RW(field)
 455
 456 /* for more info, see Documentation/ABI/testing/sysfs-bus-rpmsg */
 457 rpmsg_show_attr(name, id.name, "%s\n");
 458 rpmsg_show_attr(src, src, "0x%x\n");
 459 rpmsg_show_attr(dst, dst, "0x%x\n");
 460 rpmsg_show_attr(announce, announce ? "true" : "false", "%s\n");
 461 rpmsg_string_attr(driver_override, driver_override);
 462
 463 static ssize_t modalias_show(struct device *dev,
 464                              struct device_attribute *attr, char *buf)
 465 {
 466         struct rpmsg_device *rpdev = to_rpmsg_device(dev);
 467         ssize_t len;
 468
 469         len = of_device_modalias(dev, buf, PAGE_SIZE);
 470         if (len != -ENODEV)
 471                 return len;
 472
 473         return sprintf(buf, RPMSG_DEVICE_MODALIAS_FMT "\n", rpdev->id.name);
 474 }
 475 static DEVICE_ATTR_RO(modalias);
 476
 477 static struct attribute *rpmsg_dev_attrs[] = {
 478         &dev_attr_name.attr,
 479         &dev_attr_modalias.attr,
 480         &dev_attr_dst.attr,
 481         &dev_attr_src.attr,
 482         &dev_attr_announce.attr,
 483         &dev_attr_driver_override.attr,
 484         NULL,
 485 };
 486 ATTRIBUTE_GROUPS(rpmsg_dev);
 487
 488 /* rpmsg devices and drivers are matched using the service name */
 489 static inline int rpmsg_id_match(const struct rpmsg_device *rpdev,
 490                                   const struct rpmsg_device_id *id)
 491 {
 492         return strncmp(id->name, rpdev->id.name, RPMSG_NAME_SIZE) == 0;
 493 }
 494
 495 /* match rpmsg channel and rpmsg driver */
 496 static int rpmsg_dev_match(struct device *dev, const struct device_driver *drv)
 497 {
 498         struct rpmsg_device *rpdev = to_rpmsg_device(dev);
 499         const struct rpmsg_driver *rpdrv = to_rpmsg_driver(drv);
 500         const struct rpmsg_device_id *ids = rpdrv->id_table;
 501         unsigned int i;
 502
 503         if (rpdev->driver_override)
 504                 return !strcmp(rpdev->driver_override, drv->name);
 505
 506         if (ids)
 507                 for (i = 0; ids[i].name[0]; i++)
 508                         if (rpmsg_id_match(rpdev, &ids[i])) {
 509                                 rpdev->id.driver_data = ids[i].driver_data;
 510                                 return 1;
 511                         }
 512
 513         return of_driver_match_device(dev, drv);
 514 }
 515
 516 static int rpmsg_uevent(const struct device *dev, struct kobj_uevent_env *env)
 517 {
 518         const struct rpmsg_device *rpdev = to_rpmsg_device(dev);
 519         int ret;
 520
 521         ret = of_device_uevent_modalias(dev, env);
 522         if (ret != -ENODEV)
 523                 return ret;
 524
 525         return add_uevent_var(env, "MODALIAS=" RPMSG_DEVICE_MODALIAS_FMT,
 526                                         rpdev->id.name);
 527 }
 528
 529 /*
 530  * when an rpmsg driver is probed with a channel, we seamlessly create
 531  * it an endpoint, binding its rx callback to a unique local rpmsg
 532  * address.
 533  *
 534  * if we need to, we also announce about this channel to the remote
 535  * processor (needed in case the driver is exposing an rpmsg service).
 536  */
 537 static int rpmsg_dev_probe(struct device *dev)
 538 {
 539         struct rpmsg_device *rpdev = to_rpmsg_device(dev);
 540         struct rpmsg_driver *rpdrv = to_rpmsg_driver(rpdev->dev.driver);
 541         struct rpmsg_channel_info chinfo = {};
 542         struct rpmsg_endpoint *ept = NULL;
 543         int err;
 544
 545         err = dev_pm_domain_attach(dev, true);
 546         if (err)
 547                 goto out;
 548
 549         if (rpdrv->callback) {
 550                 strscpy(chinfo.name, rpdev->id.name, sizeof(chinfo.name));
 551                 chinfo.src = rpdev->src;
 552                 chinfo.dst = RPMSG_ADDR_ANY;
 553
 554                 ept = rpmsg_create_ept(rpdev, rpdrv->callback, NULL, chinfo);
 555                 if (!ept) {
 556                         dev_err(dev, "failed to create endpoint\n");
 557                         err = -ENOMEM;
 558                         goto out;
 559                 }
 560
 561                 rpdev->ept = ept;
 562                 rpdev->src = ept->addr;
 563
 564                 ept->flow_cb = rpdrv->flowcontrol;
 565         }
 566
 567         err = rpdrv->probe(rpdev);
 568         if (err) {
 569                 dev_err(dev, "%s: failed: %d\n", __func__, err);
 570                 goto destroy_ept;
 571         }
 572
 573         if (ept && rpdev->ops->announce_create) {
 574                 err = rpdev->ops->announce_create(rpdev);
 575                 if (err) {
 576                         dev_err(dev, "failed to announce creation\n");
 577                         goto remove_rpdev;
 578                 }
 579         }
 580
 581         return 0;
 582
 583 remove_rpdev:
 584         if (rpdrv->remove)
 585                 rpdrv->remove(rpdev);
 586 destroy_ept:
 587         if (ept)
 588                 rpmsg_destroy_ept(ept);
 589 out:
 590         return err;
 591 }
 592
 593 static void rpmsg_dev_remove(struct device *dev)
 594 {
 595         struct rpmsg_device *rpdev = to_rpmsg_device(dev);
 596         struct rpmsg_driver *rpdrv = to_rpmsg_driver(rpdev->dev.driver);
 597
 598         if (rpdev->ops->announce_destroy)
 599                 rpdev->ops->announce_destroy(rpdev);
 600
 601         if (rpdrv->remove)
 602                 rpdrv->remove(rpdev);
 603
 604         dev_pm_domain_detach(dev, true);
 605
 606         if (rpdev->ept)
 607                 rpmsg_destroy_ept(rpdev->ept);
 608 }
 609
 610 static const struct bus_type rpmsg_bus = {
 611         .name           = "rpmsg",
 612         .match          = rpmsg_dev_match,
 613         .dev_groups     = rpmsg_dev_groups,
 614         .uevent         = rpmsg_uevent,
 615         .probe          = rpmsg_dev_probe,
 616         .remove         = rpmsg_dev_remove,
 617 };
 618
 619 /*
 620  * A helper for registering rpmsg device with driver override and name.
 621  * Drivers should not be using it, but instead rpmsg_register_device().
 622  */
 623 int rpmsg_register_device_override(struct rpmsg_device *rpdev,
 624                                    const char *driver_override)
 625 {
 626         struct device *dev = &rpdev->dev;
 627         int ret;
 628
 629         if (driver_override)
 630                 strscpy_pad(rpdev->id.name, driver_override, RPMSG_NAME_SIZE);
 631
 632         dev_set_name(dev, "%s.%s.%d.%d", dev_name(dev->parent),
 633                      rpdev->id.name, rpdev->src, rpdev->dst);
 634
 635         dev->bus = &rpmsg_bus;
 636
 637         device_initialize(dev);
 638         if (driver_override) {
 639                 ret = driver_set_override(dev, &rpdev->driver_override,
 640                                           driver_override,
 641                                           strlen(driver_override));
 642                 if (ret) {
 643                         dev_err(dev, "device_set_override failed: %d\n", ret);
 644                         put_device(dev);
 645                         return ret;
 646                 }
 647         }
 648
 649         ret = device_add(dev);
 650         if (ret) {
 651                 dev_err(dev, "device_add failed: %d\n", ret);
 652                 kfree(rpdev->driver_override);
 653                 rpdev->driver_override = NULL;
 654                 put_device(dev);
 655         }
 656
 657         return ret;
 658 }
 659 EXPORT_SYMBOL(rpmsg_register_device_override);
 660
 661 int rpmsg_register_device(struct rpmsg_device *rpdev)
 662 {
 663         return rpmsg_register_device_override(rpdev, NULL);
 664 }
 665 EXPORT_SYMBOL(rpmsg_register_device);
 666
 667 /*
 668  * find an existing channel using its name + address properties,
 669  * and destroy it
 670  */
 671 int rpmsg_unregister_device(struct device *parent,
 672                             struct rpmsg_channel_info *chinfo)
 673 {
 674         struct device *dev;
 675
 676         dev = rpmsg_find_device(parent, chinfo);
 677         if (!dev)
 678                 return -EINVAL;
 679
 680         device_unregister(dev);
 681
 682         put_device(dev);
 683
 684         return 0;
 685 }
 686 EXPORT_SYMBOL(rpmsg_unregister_device);
 687
 688 /**
 689  * __register_rpmsg_driver() - register an rpmsg driver with the rpmsg bus
 690  * @rpdrv: pointer to a struct rpmsg_driver
 691  * @owner: owning module/driver
 692  *
 693  * Return: 0 on success, and an appropriate error value on failure.
 694  */
 695 int __register_rpmsg_driver(struct rpmsg_driver *rpdrv, struct module *owner)
 696 {
 697         rpdrv->drv.bus = &rpmsg_bus;
 698         rpdrv->drv.owner = owner;
 699         return driver_register(&rpdrv->drv);
 700 }
 701 EXPORT_SYMBOL(__register_rpmsg_driver);
 702
 703 /**
 704  * unregister_rpmsg_driver() - unregister an rpmsg driver from the rpmsg bus
 705  * @rpdrv: pointer to a struct rpmsg_driver
 706  *
 707  * Return: 0 on success, and an appropriate error value on failure.
 708  */
 709 void unregister_rpmsg_driver(struct rpmsg_driver *rpdrv)
 710 {
 711         driver_unregister(&rpdrv->drv);
 712 }
 713 EXPORT_SYMBOL(unregister_rpmsg_driver);
 714
 715
 716 static int __init rpmsg_init(void)
 717 {
 718         int ret;
 719
 720         ret = class_register(&rpmsg_class);
 721         if (ret) {
 722                 pr_err("failed to register rpmsg class\n");
 723                 return ret;
 724         }
 725
 726         ret = bus_register(&rpmsg_bus);
 727         if (ret) {
 728                 pr_err("failed to register rpmsg bus: %d\n", ret);
 729                 class_destroy(&rpmsg_class);
 730         }
 731         return ret;
 732 }
 733 postcore_initcall(rpmsg_init);
 734
 735 static void __exit rpmsg_fini(void)
 736 {
 737         bus_unregister(&rpmsg_bus);
 738         class_destroy(&rpmsg_class);
 739 }
 740 module_exit(rpmsg_fini);
 741
 742 MODULE_DESCRIPTION("remote processor messaging bus");
 743 MODULE_LICENSE("GPL v2");