Cyril Bur | 314929b | 2016-10-14 15:55:16 +1100 | [diff] [blame] | 1 | /* 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 Gupta | 90b92fe | 2017-05-05 17:34:00 +0530 | [diff] [blame] | 29 | void (*mbox_vlog)(int p, const char *fmt, va_list args); |
| 30 | |
| 31 | enum verbose verbosity; |
| 32 | |
Cyril Bur | 314929b | 2016-10-14 15:55:16 +1100 | [diff] [blame] | 33 | void 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))) |
| 46 | void 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 | |
| 55 | uint16_t get_u16(uint8_t *ptr) |
| 56 | { |
Andrew Jeffery | 7a3814b | 2018-02-23 16:00:43 +1030 | [diff] [blame^] | 57 | return le16toh(*(uint16_t *)ptr); |
Cyril Bur | 314929b | 2016-10-14 15:55:16 +1100 | [diff] [blame] | 58 | } |
| 59 | |
| 60 | void put_u16(uint8_t *ptr, uint16_t val) |
| 61 | { |
Andrew Jeffery | 7a3814b | 2018-02-23 16:00:43 +1030 | [diff] [blame^] | 62 | val = htole16(val); |
Cyril Bur | 314929b | 2016-10-14 15:55:16 +1100 | [diff] [blame] | 63 | memcpy(ptr, &val, sizeof(val)); |
| 64 | } |
| 65 | |
| 66 | uint32_t get_u32(uint8_t *ptr) |
| 67 | { |
Andrew Jeffery | 7a3814b | 2018-02-23 16:00:43 +1030 | [diff] [blame^] | 68 | return le32toh(*(uint32_t *)ptr); |
Cyril Bur | 314929b | 2016-10-14 15:55:16 +1100 | [diff] [blame] | 69 | } |
| 70 | |
| 71 | void put_u32(uint8_t *ptr, uint32_t val) |
| 72 | { |
Andrew Jeffery | 7a3814b | 2018-02-23 16:00:43 +1030 | [diff] [blame^] | 73 | val = htole32(val); |
Cyril Bur | 314929b | 2016-10-14 15:55:16 +1100 | [diff] [blame] | 74 | memcpy(ptr, &val, sizeof(val)); |
| 75 | } |
| 76 | |