Changeset 23 for trunk/kernel/syscalls/sys_gettimeofday.c

Timestamp:

Jun 18, 2017, 10:06:41 PM (7 years ago)

Author:

alain

Message:

Introduce syscalls.

File:

• trunk/kernel/syscalls/sys_gettimeofday.c (modified) (2 diffs)

trunk/kernel/syscalls/sys_gettimeofday.c

@@ -1 +1 @@
 /*
- * sys_gettimeofday: get current time
- * 
- * Copyright (c) 2015 UPMC Sorbonne Universites
+ * sys_gettimeofday.c - Get current time
  *
- * This file is part of ALMOS-kernel.
+ * Author    Alain Greiner (2016,2017) 
  *
- * ALMOS-kernel is free software; you can redistribute it and/or modify it
+ * Copyright (c) UPMC Sorbonne Universites
+ *
+ * This file is part of ALMOS-MKH.
+ *
+ * ALMOS-MKH is free software; you can redistribute it and/or modify it
  * under the terms of the GNU General Public License as published by
  * the Free Software Foundation; version 2.0 of the License.
  *
- * ALMOS-kernel is distributed in the hope that it will be useful, but
+ * ALMOS-MKH is distributed in the hope that it will be useful, but
  * WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
@@ -16 +18 @@
  *
  * You should have received a copy of the GNU General Public License
- * along with ALMOS-kernel; if not, write to the Free Software Foundation,
+ * along with ALMOS-MKH; if not, write to the Free Software Foundation,
  * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
  */
 
-#include <cpu.h>
+#include <hal_types.h>
+#include <hal_uspace.h>
 #include <thread.h>
+#include <printk.h>
+#include <errno.h>
+#include <process.h>
+#include <vmm.h>
+#include <core.h>
 #include <time.h>
 
-int sys_gettimeofday(struct timeval *tv, struct timezone *tz)
+///////////////////////////////////////////
+int sys_gettimeofday( struct timeval  * tv,
+                      struct timezone * tz )
 {
-        error_t err;
-        uint_t tm_ms, tm_us;
-        struct timeval time;
+        error_t        error;
+    paddr_t        paddr;
 
-        if((tv == NULL) || NOT_IN_USPACE(tv) || NOT_IN_USPACE(tv+sizeof(*tv)))
-        {
-                err = EINVAL;
-                goto fail_inval;
-        }
+        uint32_t       tm_s;
+    uint32_t       tm_us;
 
-        if(tz) 
-                return ENOTSUPPORTED;
+        struct timeval k_tv;
 
-        cpu_get_time(current_cpu, &tm_ms, &tm_us);
-        time.tv_sec = tm_ms/1000;
-        time.tv_usec = ((tm_ms%1000)*1000)+tm_us;
+        thread_t  *    this    = CURRENT_THREAD;
+        process_t *    process = this->process;
 
-        //printk(INFO, "%s: [%d] (%u ms) sec %u, usec %u\n", __FUNCTION__, 
-        //current_cpu->gid, tm_ms, (uint32_t)time.tv_sec, (uint32_t)time.tv_usec);
+    // check tz (non supported / must be null)
+    if( tz )
+    {
+        printk("\n[ERROR] in %s for thread %x in process %x : tz argument must be NULL\n",
+               __FUNCTION__ , this->trdid , process->pid );
+        this->errno = EINVAL;
+        return -1;
+    }
+ 
+    // check tv
+    error = vmm_v2p_translate( false , tv , &paddr );
 
-        err    = cpu_copy_to_uspace(tv, &time, sizeof(time));
+    if( error )
+    {
+        printk("\n[ERROR] in %s for thread %x in process %x : tv argument unmapped\n",
+        __FUNCTION__ , this->trdid , process->pid );
+        this->errno = EINVAL;
+        return -1;
+    }
 
-fail_inval:
-        current_thread->info.errno = err;
-        return err; 
-}
+    // get time from calling core descriptor
+    core_get_time( this->core , &tm_s , &tm_us );
+        k_tv.tv_sec  = tm_s;
+        k_tv.tv_usec = tm_us;
+
+    // copy values to user space
+        hal_copy_to_uspace( tv , &k_tv , sizeof(struct timeval) );
+
+    hal_wbflush();
+
+        return 0; 
+
+}  // end sys_timeofday()