feature: rproc_char_endpt_get_local_port

Signed-off-by: Subhajit Paul <subhajit_paul@ti.com>

2 files changed, 67 insertions, 0 deletions

diff --git a/rpmsg_char_helper.c b/rpmsg_char_helper.c
index 071a19a..fd424e7 100644
--- a/rpmsg_char_helper.c
+++ b/rpmsg_char_helper.c
@@ -665,6 +665,72 @@ out:
         return ept;
 }
 
+int rproc_char_endpt_get_local_port(rproc_char_endpt_t *ept)
+{
+        struct rproc_device *dev;
+        struct rproc_map *r;
+        struct rproc_char_device *cdev;
+        char *ept_src_path;
+        int fd;
+        char buf[32];
+        int ret;
+        uint32_t src;
+
+        if(!ept) {
+                printerr("%s: ept = NULL not allowed\n", __func__);
+                return -1;
+        }
+
+        cdev = ept->cdev;
+        if(!cdev) {
+                printerr("%s: malformed ept -> cdev = NULL\n", __func__);
+                return -1;
+        }
+
+        dev = cdev->dev;
+        if(!dev) {
+                printerr("%s: malformed ept -> dev = NULL\n", __func__);
+                return -1;
+        }
+
+        r = dev->priv;
+        if(!r || (r - &maps[0]) >= NUM_RPROCS) {
+                printerr("%s: malformed ept -> bad dev->priv \n", __func__);
+                return -1;
+        }
+
+        ept_src_path = str_join("%s/remoteproc/remoteproc%u/virtio%u/virtio%u.rpmsg_chrdev.%d.%d/rpmsg/rpmsg_ctrl%u/rpmsg%u/src",
+                        r->sysfs_path, dev->remoteproc_id, dev->virtio_id, dev->virtio_id,
+                        cdev->src, cdev->dst, cdev->ctrl_id, ept->rpmsg_id);
+        if(ept_src_path)
+                fd = open(ept_src_path, O_RDONLY);
+        if(!ept_src_path || fd < 0) {
+                printerr("%s: could not open endpoint src for %s\n", __func__, ept->rpmsg_id);
+                if(ept_src_path)
+                        free(ept_src_path);
+                return -1;
+        }
+        free(ept_src_path);
+
+        ret = read(fd, buf, 32);
+        close(fd);
+
+        if(ret <= 0) {
+                printerr("%s: could not read src file\n", __func__);
+                return -1;
+        }
+
+        buf[ret - 1] = '\0';
+
+        ret = sscanf(buf, "%u", &src);
+        if(ret != 1) {
+                printerr("%s: could not read src file data\n", __func__);
+                return -1;
+        }
+
+        return src;
+}
+
 char *rproc_char_endpt_get_dev_name(rproc_char_endpt_t *ept)
 {
         if(!ept) {
diff --git a/rpmsg_char_helper.h b/rpmsg_char_helper.h
index 78a72a4..cb1a899 100644
--- a/rpmsg_char_helper.h
+++ b/rpmsg_char_helper.h
@@ -33,6 +33,7 @@ rproc_char_endpt_t *rproc_char_device_create_endpt(rproc_char_device_t *cdev, ch
 rproc_char_endpt_t *rproc_char_device_find_endpt_by_name(rproc_char_device_t *cdev, char *name);
 rproc_char_endpt_t *rproc_char_device_find_endpt_by_local_port(rproc_char_device_t *cdev, int local_port);
 char *rproc_char_endpt_get_dev_name(rproc_char_endpt_t *ept);
+int rproc_char_endpt_get_local_port(rproc_char_endpt_t *ept);
 
 int rproc_char_endpt_destroy(rproc_char_endpt_t *ept);