aboutsummaryrefslogtreecommitdiff
path: root/projects/libhal-test/gettimeofday.c
blob: f7a87f1ef300e47690bd3807d7b6b2ab9ab18de5 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
/*
 * gettimeofday.c
 * --------------
 * A simple implementation of gettimeofday() for CMSIS.
 * This assumes a 1ms SysTick. It obviously does not return the absolute time,
 * just the time since boot, but it's only used to calculate elapsed time in
 * code we're porting from unix.
 *
 * Copyright (c) 2015, NORDUnet A/S All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are
 * met:
 * - Redistributions of source code must retain the above copyright notice,
 *   this list of conditions and the following disclaimer.
 *
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 *
 * - Neither the name of the NORDUnet nor the names of its contributors may
 *   be used to endorse or promote products derived from this software
 *   without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
 * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
 * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include <stdint.h>

#include "stm32f4xx_hal.h"

/* Don't #include <sys/time.h> because of conflicting prototype in newlib. */

/* from the manpage */
struct timeval {
    time_t      tv_sec;     /* seconds */
    suseconds_t tv_usec;    /* microseconds */
};

struct timezone {
    int tz_minuteswest;     /* minutes west of Greenwich */
    int tz_dsttime;         /* type of DST correction */
};

int gettimeofday(struct timeval *tv, struct timezone *tz)
{
    uint32_t tick = HAL_GetTick();      /* uptime in ms */

    tz = tz;

    tv->tv_sec = tick / 1000;
    tv->tv_usec = (tick % 1000) * 1000;

    return 0;
}
#include <IOKit/serial/ioss.h> #include <sys/ioctl.h> #endif static int fd = -1; hal_error_t hal_serial_init(const char * const device, const uint32_t speed) { struct termios tty; speed_t termios_speed; /* * Apparently Linux is too cool to need an atomic mechanism for * locking an existing file, so we can't uses O_EXLOCK. Sigh. */ fd = open(device, O_RDWR | O_NOCTTY | O_SYNC); if (fd == -1) return perror(device), HAL_ERROR_RPC_TRANSPORT; if (flock(fd, LOCK_EX) < 0) return perror(device), HAL_ERROR_RPC_TRANSPORT; if (tcgetattr (fd, &tty) != 0) return perror("tcgetattr"), HAL_ERROR_RPC_TRANSPORT; #if !HAL_RPC_SERIAL_USE_MACOSX_IOCTL switch (speed) { case 115200: termios_speed = B115200; break; case 921600: termios_speed = B921600; break; default: fprintf(stderr, "invalid line speed %lu\n", (unsigned long) speed); return HAL_ERROR_RPC_TRANSPORT; } cfsetospeed (&tty, termios_speed); cfsetispeed (&tty, termios_speed); #endif tty.c_cflag &= ~CSIZE; tty.c_cflag |= (CS8 | CLOCAL | CREAD); tty.c_iflag = 0; tty.c_oflag = 0; tty.c_lflag = 0; tty.c_cc[VMIN] = 1; tty.c_cc[VTIME] = 0; if (tcsetattr (fd, TCSANOW, &tty) != 0) return perror("tcsetattr"), HAL_ERROR_RPC_TRANSPORT; #if HAL_RPC_SERIAL_USE_MACOSX_IOCTL termios_speed = speed; if (ioctl(fd, IOSSIOSPEED, &speed) < 0) return perror("ioctl(IOSSIOSPEED)"), HAL_ERROR_RPC_TRANSPORT; #endif return HAL_OK; } hal_error_t hal_serial_close(void) { int ret = close(fd); fd = -1; if (ret != 0) return perror("close"), HAL_ERROR_RPC_TRANSPORT; return HAL_OK; } hal_error_t hal_serial_send_char(const uint8_t c) { if (write(fd, &c, 1) != 1) return perror("write"), HAL_ERROR_RPC_TRANSPORT; return HAL_OK; } hal_error_t hal_serial_recv_char(uint8_t * const c) { if (read(fd, c, 1) != 1) return perror("read"), HAL_ERROR_RPC_TRANSPORT; return HAL_OK; } /* Access routine for the file descriptor, so daemon can poll on it. */ int hal_serial_get_fd(void) { return fd; }