blob: c4608155017e7b54ac789c0903d694ce5be29098 [file] [log] [blame]
Cyril Bur314929b2016-10-14 15:55:16 +11001/* Copyright 2016 IBM
2 *
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at
6 *
7 * http://www.apache.org/licenses/LICENSE-2.0
8 *
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
14 *
15 */
16
17#define _GNU_SOURCE
18#include <stdarg.h>
19#include <stdbool.h>
20#include <stdio.h>
21#include <stdint.h>
22#include <string.h>
23#include <sys/types.h>
24#include <syslog.h>
25#include <time.h>
26
27#include "common.h"
28
Ratan Gupta90b92fe2017-05-05 17:34:00 +053029void (*mbox_vlog)(int p, const char *fmt, va_list args);
30
31enum verbose verbosity;
32
Cyril Bur314929b2016-10-14 15:55:16 +110033void mbox_log_console(int p, const char *fmt, va_list args)
34{
35 struct timespec time;
36 FILE *s = (p < LOG_WARNING) ? stdout : stderr;
37
38 clock_gettime(CLOCK_REALTIME, &time);
39
40 fprintf(s, "[%s %ld.%.9ld] ", PREFIX, time.tv_sec, time.tv_nsec);
41
42 vfprintf(s, fmt, args);
43}
44
45__attribute__((format(printf, 2, 3)))
46void mbox_log(int p, const char *fmt, ...)
47{
48 va_list args;
49
50 va_start(args, fmt);
51 mbox_vlog(p, fmt, args);
52 va_end(args);
53}
54
55uint16_t get_u16(uint8_t *ptr)
56{
Andrew Jeffery7a3814b2018-02-23 16:00:43 +103057 return le16toh(*(uint16_t *)ptr);
Cyril Bur314929b2016-10-14 15:55:16 +110058}
59
60void put_u16(uint8_t *ptr, uint16_t val)
61{
Andrew Jeffery7a3814b2018-02-23 16:00:43 +103062 val = htole16(val);
Cyril Bur314929b2016-10-14 15:55:16 +110063 memcpy(ptr, &val, sizeof(val));
64}
65
66uint32_t get_u32(uint8_t *ptr)
67{
Andrew Jeffery7a3814b2018-02-23 16:00:43 +103068 return le32toh(*(uint32_t *)ptr);
Cyril Bur314929b2016-10-14 15:55:16 +110069}
70
71void put_u32(uint8_t *ptr, uint32_t val)
72{
Andrew Jeffery7a3814b2018-02-23 16:00:43 +103073 val = htole32(val);
Cyril Bur314929b2016-10-14 15:55:16 +110074 memcpy(ptr, &val, sizeof(val));
75}
76