diff mbox series

[07/13] target/arm/arm-semi: Factor out implementation of SYS_READ

Message ID 20190910144428.32597-8-peter.maydell@linaro.org
State Superseded
Headers show
Series target/arm: Implement semihosting v2.0 | expand

Commit Message

Peter Maydell Sept. 10, 2019, 2:44 p.m. UTC 
Factor out the implementation of SYS_READ via the
new function tables.

Signed-off-by: Peter Maydell <peter.maydell@linaro.org>

---
 target/arm/arm-semi.c | 57 ++++++++++++++++++++++++++++---------------
 1 file changed, 37 insertions(+), 20 deletions(-)

-- 
2.20.1

Comments

Alex Bennée Sept. 12, 2019, 11:19 a.m. UTC | #1 
Peter Maydell <peter.maydell@linaro.org> writes:

> Factor out the implementation of SYS_READ via the

> new function tables.


"As for SYS_WRITE we need env for lock_user in system emulation."?

>

> Signed-off-by: Peter Maydell <peter.maydell@linaro.org>


Either way:

Reviewed-by: Alex Bennée <alex.bennee@linaro.org>


> ---

>  target/arm/arm-semi.c | 57 ++++++++++++++++++++++++++++---------------

>  1 file changed, 37 insertions(+), 20 deletions(-)

>

> diff --git a/target/arm/arm-semi.c b/target/arm/arm-semi.c

> index 0dec4c04e2f..48a10dd3c3a 100644

> --- a/target/arm/arm-semi.c

> +++ b/target/arm/arm-semi.c

> @@ -347,6 +347,8 @@ static target_ulong arm_gdb_syscall(ARMCPU *cpu, gdb_syscall_complete_cb cb,

>  typedef uint32_t sys_closefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf);

>  typedef uint32_t sys_writefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,

>                               target_ulong buf, uint32_t len);

> +typedef uint32_t sys_readfn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,

> +                            target_ulong buf, uint32_t len);

>

>  static uint32_t host_closefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf)

>  {

> @@ -374,6 +376,29 @@ static uint32_t host_writefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,

>      return len - ret;

>  }

>

> +static uint32_t host_readfn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,

> +                            target_ulong buf, uint32_t len)

> +{

> +    uint32_t ret;

> +#ifndef CONFIG_USER_ONLY

> +    CPUARMState *env = &cpu->env;

> +#endif

> +    char *s = lock_user(VERIFY_WRITE, buf, len, 0);

> +    if (!s) {

> +        /* return bytes not read */

> +        return len;

> +    }

> +    do {

> +        ret = set_swi_errno(ts, read(gf->hostfd, s, len));

> +    } while (ret == -1 && errno == EINTR);

> +    unlock_user(s, buf, len);

> +    if (ret == (uint32_t)-1) {

> +        ret = 0;

> +    }

> +    /* Return bytes not read */

> +    return len - ret;

> +}

> +

>  static uint32_t gdb_closefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf)

>  {

>      return arm_gdb_syscall(cpu, arm_semi_cb, "close,%x", gf->hostfd);

> @@ -387,19 +412,30 @@ static uint32_t gdb_writefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,

>                             gf->hostfd, buf, len);

>  }

>

> +static uint32_t gdb_readfn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,

> +                           target_ulong buf, uint32_t len)

> +{

> +    arm_semi_syscall_len = len;

> +    return arm_gdb_syscall(cpu, arm_semi_cb, "read,%x,%x,%x",

> +                           gf->hostfd, buf, len);

> +}

> +

>  typedef struct GuestFDFunctions {

>      sys_closefn *closefn;

>      sys_writefn *writefn;

> +    sys_readfn *readfn;

>  } GuestFDFunctions;

>

>  static const GuestFDFunctions guestfd_fns[] = {

>      [GuestFDHost] = {

>          .closefn = host_closefn,

>          .writefn = host_writefn,

> +        .readfn = host_readfn,

>      },

>      [GuestFDGDB] = {

>          .closefn = gdb_closefn,

>          .writefn = gdb_writefn,

> +        .readfn = gdb_readfn,

>      },

>  };

>

> @@ -551,26 +587,7 @@ target_ulong do_arm_semihosting(CPUARMState *env)

>              return set_swi_errno(ts, -1);

>          }

>

> -        if (use_gdb_syscalls()) {

> -            arm_semi_syscall_len = len;

> -            return arm_gdb_syscall(cpu, arm_semi_cb, "read,%x,%x,%x",

> -                                   gf->hostfd, arg1, len);

> -        } else {

> -            s = lock_user(VERIFY_WRITE, arg1, len, 0);

> -            if (!s) {

> -                /* return bytes not read */

> -                return len;

> -            }

> -            do {

> -                ret = set_swi_errno(ts, read(gf->hostfd, s, len));

> -            } while (ret == -1 && errno == EINTR);

> -            unlock_user(s, arg1, len);

> -            if (ret == (uint32_t)-1) {

> -                ret = 0;

> -            }

> -            /* Return bytes not read */

> -            return len - ret;

> -        }

> +        return guestfd_fns[gf->type].readfn(ts, cpu, gf, arg1, len);

>      case TARGET_SYS_READC:

>          qemu_log_mask(LOG_UNIMP, "%s: SYS_READC not implemented", __func__);

>          return 0;



--
Alex Bennée
diff mbox series

Patch

diff --git a/target/arm/arm-semi.c b/target/arm/arm-semi.c
index 0dec4c04e2f..48a10dd3c3a 100644
--- a/target/arm/arm-semi.c
+++ b/target/arm/arm-semi.c
@@ -347,6 +347,8 @@  static target_ulong arm_gdb_syscall(ARMCPU *cpu, gdb_syscall_complete_cb cb,
 typedef uint32_t sys_closefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf);
 typedef uint32_t sys_writefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,
                              target_ulong buf, uint32_t len);
+typedef uint32_t sys_readfn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,
+                            target_ulong buf, uint32_t len);
 
 static uint32_t host_closefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf)
 {
@@ -374,6 +376,29 @@  static uint32_t host_writefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,
     return len - ret;
 }
 
+static uint32_t host_readfn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,
+                            target_ulong buf, uint32_t len)
+{
+    uint32_t ret;
+#ifndef CONFIG_USER_ONLY
+    CPUARMState *env = &cpu->env;
+#endif
+    char *s = lock_user(VERIFY_WRITE, buf, len, 0);
+    if (!s) {
+        /* return bytes not read */
+        return len;
+    }
+    do {
+        ret = set_swi_errno(ts, read(gf->hostfd, s, len));
+    } while (ret == -1 && errno == EINTR);
+    unlock_user(s, buf, len);
+    if (ret == (uint32_t)-1) {
+        ret = 0;
+    }
+    /* Return bytes not read */
+    return len - ret;
+}
+
 static uint32_t gdb_closefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf)
 {
     return arm_gdb_syscall(cpu, arm_semi_cb, "close,%x", gf->hostfd);
@@ -387,19 +412,30 @@  static uint32_t gdb_writefn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,
                            gf->hostfd, buf, len);
 }
 
+static uint32_t gdb_readfn(TaskState *ts, ARMCPU *cpu, GuestFD *gf,
+                           target_ulong buf, uint32_t len)
+{
+    arm_semi_syscall_len = len;
+    return arm_gdb_syscall(cpu, arm_semi_cb, "read,%x,%x,%x",
+                           gf->hostfd, buf, len);
+}
+
 typedef struct GuestFDFunctions {
     sys_closefn *closefn;
     sys_writefn *writefn;
+    sys_readfn *readfn;
 } GuestFDFunctions;
 
 static const GuestFDFunctions guestfd_fns[] = {
     [GuestFDHost] = {
         .closefn = host_closefn,
         .writefn = host_writefn,
+        .readfn = host_readfn,
     },
     [GuestFDGDB] = {
         .closefn = gdb_closefn,
         .writefn = gdb_writefn,
+        .readfn = gdb_readfn,
     },
 };
 
@@ -551,26 +587,7 @@  target_ulong do_arm_semihosting(CPUARMState *env)
             return set_swi_errno(ts, -1);
         }
 
-        if (use_gdb_syscalls()) {
-            arm_semi_syscall_len = len;
-            return arm_gdb_syscall(cpu, arm_semi_cb, "read,%x,%x,%x",
-                                   gf->hostfd, arg1, len);
-        } else {
-            s = lock_user(VERIFY_WRITE, arg1, len, 0);
-            if (!s) {
-                /* return bytes not read */
-                return len;
-            }
-            do {
-                ret = set_swi_errno(ts, read(gf->hostfd, s, len));
-            } while (ret == -1 && errno == EINTR);
-            unlock_user(s, arg1, len);
-            if (ret == (uint32_t)-1) {
-                ret = 0;
-            }
-            /* Return bytes not read */
-            return len - ret;
-        }
+        return guestfd_fns[gf->type].readfn(ts, cpu, gf, arg1, len);
     case TARGET_SYS_READC:
         qemu_log_mask(LOG_UNIMP, "%s: SYS_READC not implemented", __func__);
         return 0;