add nimble mesh example
need meshctl installed on raspberrypi. nimble offical samples have a lot of pit ...
This commit is contained in:
@@ -21,7 +21,7 @@
|
||||
#define _MESH_GLUE_
|
||||
|
||||
#include <assert.h>
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
|
||||
#include "syscfg/syscfg.h"
|
||||
#include "nimble/nimble_npl.h"
|
||||
|
@@ -6,7 +6,7 @@
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*/
|
||||
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
|
||||
#include <os/os_mbuf.h>
|
||||
#include "mesh/mesh.h"
|
||||
|
@@ -14,6 +14,31 @@ extern "C"
|
||||
{
|
||||
#endif
|
||||
|
||||
/*
|
||||
* Clang and recent GCC both provide predefined macros for the memory
|
||||
* orderings. If we are using a compiler that doesn't define them, use the
|
||||
* clang values - these will be ignored in the fallback path.
|
||||
*/
|
||||
|
||||
#ifndef __ATOMIC_RELAXED
|
||||
#define __ATOMIC_RELAXED 0
|
||||
#endif
|
||||
#ifndef __ATOMIC_CONSUME
|
||||
#define __ATOMIC_CONSUME 1
|
||||
#endif
|
||||
#ifndef __ATOMIC_ACQUIRE
|
||||
#define __ATOMIC_ACQUIRE 2
|
||||
#endif
|
||||
#ifndef __ATOMIC_RELEASE
|
||||
#define __ATOMIC_RELEASE 3
|
||||
#endif
|
||||
#ifndef __ATOMIC_ACQ_REL
|
||||
#define __ATOMIC_ACQ_REL 4
|
||||
#endif
|
||||
#ifndef __ATOMIC_SEQ_CST
|
||||
#define __ATOMIC_SEQ_CST 5
|
||||
#endif
|
||||
|
||||
typedef int atomic_t;
|
||||
typedef atomic_t atomic_val_t;
|
||||
|
||||
|
@@ -6,7 +6,7 @@
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*/
|
||||
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
#include <assert.h>
|
||||
#include "os/os_mbuf.h"
|
||||
#include "mesh/mesh.h"
|
||||
|
@@ -13,7 +13,7 @@
|
||||
#include "mesh/mesh.h"
|
||||
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
#include <stdbool.h>
|
||||
|
||||
#include "net.h"
|
||||
|
@@ -7,7 +7,7 @@
|
||||
*/
|
||||
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
#include <stdbool.h>
|
||||
|
||||
#include "mesh/mesh.h"
|
||||
|
@@ -8,7 +8,7 @@
|
||||
|
||||
#include <string.h>
|
||||
#include <stdbool.h>
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
|
||||
#include <tinycrypt/constants.h>
|
||||
#include <tinycrypt/utils.h>
|
||||
|
@@ -11,7 +11,7 @@
|
||||
#if MYNEWT_VAL(BLE_MESH_FRIEND)
|
||||
|
||||
#include <stdint.h>
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
#include <assert.h>
|
||||
|
||||
#define BT_DBG_ENABLED (MYNEWT_VAL(BLE_MESH_DEBUG_FRIEND))
|
||||
|
@@ -7,7 +7,7 @@
|
||||
*/
|
||||
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
#include <stdbool.h>
|
||||
|
||||
#include "syscfg/syscfg.h"
|
||||
|
@@ -7,7 +7,7 @@
|
||||
*/
|
||||
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
#include <stdbool.h>
|
||||
|
||||
#include "syscfg/syscfg.h"
|
||||
|
@@ -8,7 +8,7 @@
|
||||
#include "syscfg/syscfg.h"
|
||||
#if MYNEWT_VAL(BLE_MESH_PROV)
|
||||
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
|
||||
#define BT_DBG_ENABLED (MYNEWT_VAL(BLE_MESH_DEBUG_PROV))
|
||||
#include "host/ble_hs_log.h"
|
||||
|
@@ -15,8 +15,8 @@
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <ctype.h>
|
||||
#include <errno.h>
|
||||
#include "shell/shell.h"
|
||||
#include "errno.h"
|
||||
#include "shell.h"
|
||||
#include "console/console.h"
|
||||
#include "mesh/mesh.h"
|
||||
#include "mesh/main.h"
|
||||
@@ -43,10 +43,10 @@
|
||||
#define BLE_MESH_SHELL_TASK_PRIO 126
|
||||
#define BLE_MESH_SHELL_STACK_SIZE 768
|
||||
|
||||
OS_TASK_STACK_DEFINE(g_blemesh_shell_stack, BLE_MESH_SHELL_STACK_SIZE);
|
||||
BLE_NPL_OS_TASK_STACK_DEFINE(g_blemesh_shell_stack, BLE_MESH_SHELL_STACK_SIZE);
|
||||
|
||||
struct os_task mesh_shell_task;
|
||||
static struct os_eventq mesh_shell_queue;
|
||||
struct ble_npl_task mesh_shell_task;
|
||||
static struct ble_npl_eventq mesh_shell_queue;
|
||||
|
||||
#define CID_NVAL 0xffff
|
||||
#define CID_VENDOR 0x05C3
|
||||
@@ -2720,17 +2720,28 @@ static const struct shell_cmd mesh_commands[] = {
|
||||
|
||||
static void mesh_shell_thread(void *args)
|
||||
{
|
||||
#if 0
|
||||
while (1) {
|
||||
os_eventq_run(&mesh_shell_queue);
|
||||
}
|
||||
#else
|
||||
|
||||
struct ble_npl_event *ev;
|
||||
|
||||
while (1) {
|
||||
ev = ble_npl_eventq_get(&mesh_shell_queue, BLE_NPL_TIME_FOREVER);
|
||||
ble_npl_event_run(ev);
|
||||
}
|
||||
|
||||
#endif
|
||||
}
|
||||
|
||||
static void bt_mesh_shell_task_init(void)
|
||||
{
|
||||
os_eventq_init(&mesh_shell_queue);
|
||||
npl_tencentos_tiny_eventq_init(&mesh_shell_queue);
|
||||
|
||||
os_task_init(&mesh_shell_task, "mesh_sh", mesh_shell_thread, NULL,
|
||||
BLE_MESH_SHELL_TASK_PRIO, OS_WAIT_FOREVER, g_blemesh_shell_stack,
|
||||
ble_npl_task_init(&mesh_shell_task, "mesh_sh", mesh_shell_thread, NULL,
|
||||
BLE_MESH_SHELL_TASK_PRIO, BLE_NPL_TIME_FOREVER, g_blemesh_shell_stack,
|
||||
BLE_MESH_SHELL_STACK_SIZE);
|
||||
}
|
||||
#endif
|
||||
|
@@ -1,6 +1,29 @@
|
||||
#ifndef __SHELL_H__
|
||||
#define __SHELL_H__
|
||||
|
||||
/** @brief Callback called when command is entered.
|
||||
*
|
||||
* @param argc Number of parameters passed.
|
||||
* @param argv Array of option strings. First option is always command name.
|
||||
*
|
||||
* @return 0 in case of success or negative value in case of error.
|
||||
*/
|
||||
typedef int (*shell_cmd_func_t)(int argc, char *argv[]);
|
||||
|
||||
struct shell_cmd_help {
|
||||
const char *summary;
|
||||
const char *usage;
|
||||
const struct shell_param *params;
|
||||
};
|
||||
|
||||
struct shell_cmd {
|
||||
uint8_t sc_ext : 1; /* 1 if this is an extended shell comand. */
|
||||
shell_cmd_func_t sc_cmd_func;
|
||||
|
||||
const char *sc_cmd;
|
||||
const struct shell_cmd_help *help;
|
||||
};
|
||||
|
||||
void ble_mesh_shell_init(void);
|
||||
|
||||
#endif
|
||||
|
@@ -7,7 +7,7 @@
|
||||
*/
|
||||
|
||||
|
||||
#include <errno.h>
|
||||
#include "errno.h"
|
||||
#include <string.h>
|
||||
|
||||
#include "mesh/mesh.h"
|
||||
|
@@ -1,18 +1,6 @@
|
||||
#ifndef _CONSOLE_H_
|
||||
#define _CONSOLE_H_
|
||||
|
||||
#if 0
|
||||
|
||||
#include "tos.h"
|
||||
|
||||
#define console_printf tos_kprintf
|
||||
|
||||
// we need a console
|
||||
#define console_init(...) -1
|
||||
#define console_write(...) printf(__VA_ARGS__);
|
||||
#define console_read(...) -1
|
||||
#endif
|
||||
|
||||
#define console_init(...) -1
|
||||
|
||||
int console_printf(const char *fmt, ...);
|
||||
|
@@ -0,0 +1,136 @@
|
||||
#ifndef _BLE_PORT_ERRNO_H_
|
||||
#define _BLE_PORT_ERRNO_H_
|
||||
|
||||
#define EPERM 1 /* Operation not permitted */
|
||||
#define ENOENT 2 /* No such file or directory */
|
||||
#define ESRCH 3 /* No such process */
|
||||
#define EINTR 4 /* Interrupted system call */
|
||||
#define EIO 5 /* I/O error */
|
||||
#define ENXIO 6 /* No such device or address */
|
||||
#define E2BIG 7 /* Arg list too long */
|
||||
#define ENOEXEC 8 /* Exec format error */
|
||||
#define EBADF 9 /* Bad file number */
|
||||
#define ECHILD 10 /* No child processes */
|
||||
#define EAGAIN 11 /* Try again */
|
||||
#define ENOMEM 12 /* Out of memory */
|
||||
#define EACCES 13 /* Permission denied */
|
||||
#define EFAULT 14 /* Bad address */
|
||||
#define ENOTBLK 15 /* Block device required */
|
||||
#define EBUSY 16 /* Device or resource busy */
|
||||
#define EEXIST 17 /* File exists */
|
||||
#define EXDEV 18 /* Cross-device link */
|
||||
#define ENODEV 19 /* No such device */
|
||||
#define ENOTDIR 20 /* Not a directory */
|
||||
#define EISDIR 21 /* Is a directory */
|
||||
#define EINVAL 22 /* Invalid argument */
|
||||
#define ENFILE 23 /* File table overflow */
|
||||
#define EMFILE 24 /* Too many open files */
|
||||
#define ENOTTY 25 /* Not a typewriter */
|
||||
#define ETXTBSY 26 /* Text file busy */
|
||||
#define EFBIG 27 /* File too large */
|
||||
#define ENOSPC 28 /* No space left on device */
|
||||
#define ESPIPE 29 /* Illegal seek */
|
||||
#define EROFS 30 /* Read-only file system */
|
||||
#define EMLINK 31 /* Too many links */
|
||||
#define EPIPE 32 /* Broken pipe */
|
||||
#define EDOM 33 /* Math argument out of domain of func */
|
||||
#define ERANGE 34 /* Math result not representable */
|
||||
#define EDEADLK 35 /* Resource deadlock would occur */
|
||||
#define ENAMETOOLONG 36 /* File name too long */
|
||||
#define ENOLCK 37 /* No record locks available */
|
||||
#define ENOSYS 38 /* Function not implemented */
|
||||
#define ENOTEMPTY 39 /* Directory not empty */
|
||||
#define ELOOP 40 /* Too many symbolic links encountered */
|
||||
#define EWOULDBLOCK EAGAIN /* Operation would block */
|
||||
#define ENOMSG 42 /* No message of desired type */
|
||||
#define EIDRM 43 /* Identifier removed */
|
||||
#define ECHRNG 44 /* Channel number out of range */
|
||||
#define EL2NSYNC 45 /* Level 2 not synchronized */
|
||||
#define EL3HLT 46 /* Level 3 halted */
|
||||
#define EL3RST 47 /* Level 3 reset */
|
||||
#define ELNRNG 48 /* Link number out of range */
|
||||
#define EUNATCH 49 /* Protocol driver not attached */
|
||||
#define ENOCSI 50 /* No CSI structure available */
|
||||
#define EL2HLT 51 /* Level 2 halted */
|
||||
#define EBADE 52 /* Invalid exchange */
|
||||
#define EBADR 53 /* Invalid request descriptor */
|
||||
#define EXFULL 54 /* Exchange full */
|
||||
#define ENOANO 55 /* No anode */
|
||||
#define EBADRQC 56 /* Invalid request code */
|
||||
#define EBADSLT 57 /* Invalid slot */
|
||||
|
||||
#define EDEADLOCK EDEADLK
|
||||
|
||||
#define EBFONT 59 /* Bad font file format */
|
||||
#define ENOSTR 60 /* Device not a stream */
|
||||
#define ENODATA 61 /* No data available */
|
||||
#define ETIME 62 /* Timer expired */
|
||||
#define ENOSR 63 /* Out of streams resources */
|
||||
#define ENONET 64 /* Machine is not on the network */
|
||||
#define ENOPKG 65 /* Package not installed */
|
||||
#define EREMOTE 66 /* Object is remote */
|
||||
#define ENOLINK 67 /* Link has been severed */
|
||||
#define EADV 68 /* Advertise error */
|
||||
#define ESRMNT 69 /* Srmount error */
|
||||
#define ECOMM 70 /* Communication error on send */
|
||||
#define EPROTO 71 /* Protocol error */
|
||||
#define EMULTIHOP 72 /* Multihop attempted */
|
||||
#define EDOTDOT 73 /* RFS specific error */
|
||||
#define EBADMSG 74 /* Not a data message */
|
||||
#define EOVERFLOW 75 /* Value too large for defined data type */
|
||||
#define ENOTUNIQ 76 /* Name not unique on network */
|
||||
#define EBADFD 77 /* File descriptor in bad state */
|
||||
#define EREMCHG 78 /* Remote address changed */
|
||||
#define ELIBACC 79 /* Can not access a needed shared library */
|
||||
#define ELIBBAD 80 /* Accessing a corrupted shared library */
|
||||
#define ELIBSCN 81 /* .lib section in a.out corrupted */
|
||||
#define ELIBMAX 82 /* Attempting to link in too many shared libraries */
|
||||
#define ELIBEXEC 83 /* Cannot exec a shared library directly */
|
||||
#define EILSEQ 84 /* Illegal byte sequence */
|
||||
#define ERESTART 85 /* Interrupted system call should be restarted */
|
||||
#define ESTRPIPE 86 /* Streams pipe error */
|
||||
#define EUSERS 87 /* Too many users */
|
||||
#define ENOTSOCK 88 /* Socket operation on non-socket */
|
||||
#define EDESTADDRREQ 89 /* Destination address required */
|
||||
#define EMSGSIZE 90 /* Message too long */
|
||||
#define EPROTOTYPE 91 /* Protocol wrong type for socket */
|
||||
#define ENOPROTOOPT 92 /* Protocol not available */
|
||||
#define EPROTONOSUPPORT 93 /* Protocol not supported */
|
||||
#define ESOCKTNOSUPPORT 94 /* Socket type not supported */
|
||||
#define EOPNOTSUPP 95 /* Operation not supported on transport endpoint */
|
||||
#define EPFNOSUPPORT 96 /* Protocol family not supported */
|
||||
#define EAFNOSUPPORT 97 /* Address family not supported by protocol */
|
||||
#define EADDRINUSE 98 /* Address already in use */
|
||||
#define EADDRNOTAVAIL 99 /* Cannot assign requested address */
|
||||
#define ENETDOWN 100 /* Network is down */
|
||||
#define ENETUNREACH 101 /* Network is unreachable */
|
||||
#define ENETRESET 102 /* Network dropped connection because of reset */
|
||||
#define ECONNABORTED 103 /* Software caused connection abort */
|
||||
#define ECONNRESET 104 /* Connection reset by peer */
|
||||
#define ENOBUFS 105 /* No buffer space available */
|
||||
#define EISCONN 106 /* Transport endpoint is already connected */
|
||||
#define ENOTCONN 107 /* Transport endpoint is not connected */
|
||||
#define ESHUTDOWN 108 /* Cannot send after transport endpoint shutdown */
|
||||
#define ETOOMANYREFS 109 /* Too many references: cannot splice */
|
||||
#define ETIMEDOUT 110 /* Connection timed out */
|
||||
#define ECONNREFUSED 111 /* Connection refused */
|
||||
#define EHOSTDOWN 112 /* Host is down */
|
||||
#define EHOSTUNREACH 113 /* No route to host */
|
||||
#define EALREADY 114 /* Operation already in progress */
|
||||
#define EINPROGRESS 115 /* Operation now in progress */
|
||||
#define ESTALE 116 /* Stale NFS file handle */
|
||||
#define EUCLEAN 117 /* Structure needs cleaning */
|
||||
#define ENOTNAM 118 /* Not a XENIX named type file */
|
||||
#define ENAVAIL 119 /* No XENIX semaphores available */
|
||||
#define EISNAM 120 /* Is a named type file */
|
||||
#define EREMOTEIO 121 /* Remote I/O error */
|
||||
#define EDQUOT 122 /* Quota exceeded */
|
||||
|
||||
#define ENOMEDIUM 123 /* No medium found */
|
||||
#define EMEDIUMTYPE 124 /* Wrong medium type */
|
||||
|
||||
#define ECANCELED 125
|
||||
#define ENOTSUP 126
|
||||
|
||||
#endif
|
||||
|
@@ -34,14 +34,19 @@ extern "C" {
|
||||
#define _Static_assert(...)
|
||||
#endif
|
||||
|
||||
/* This should be compatible with k_tick_t */
|
||||
typedef k_tick_t ble_npl_time_t;
|
||||
typedef int64_t ble_npl_stime_t;
|
||||
|
||||
typedef void (*ble_npl_task_entry_t)(void *args);
|
||||
typedef k_stack_t ble_npl_stack_t;
|
||||
|
||||
#define BLE_NPL_OS_TASK_STACK_DEFINE(stk, size) ble_npl_stack_t stk[size]
|
||||
|
||||
#define BLE_NPL_OS_ALIGNMENT 4
|
||||
|
||||
#define BLE_NPL_TIME_FOREVER TOS_TIME_FOREVER
|
||||
|
||||
/* This should be compatible with k_tick_t */
|
||||
typedef uint64_t ble_npl_time_t;
|
||||
typedef int64_t ble_npl_stime_t;
|
||||
|
||||
extern volatile int ble_npl_in_critical;
|
||||
|
||||
struct ble_npl_event {
|
||||
@@ -68,6 +73,10 @@ struct ble_npl_sem {
|
||||
k_sem_t handle;
|
||||
};
|
||||
|
||||
struct ble_npl_task {
|
||||
k_task_t handle;
|
||||
};
|
||||
|
||||
/*
|
||||
* Simple APIs are just defined as static inline below, but some are a bit more
|
||||
* complex or require some global state variables and thus are defined in .c
|
||||
@@ -237,6 +246,14 @@ ble_npl_callout_set_arg(struct ble_npl_callout *co, void *arg)
|
||||
co->ev.arg = arg;
|
||||
}
|
||||
|
||||
static inline ble_npl_error_t
|
||||
ble_npl_task_init(struct ble_npl_task *task, char *name, ble_npl_task_entry_t entry,
|
||||
void *arg, uint8_t prio, ble_npl_time_t sanity_itvl,
|
||||
ble_npl_stack_t *stack_bottom, uint16_t stack_size)
|
||||
{
|
||||
return npl_tencentos_tiny_task_init(task, name, entry, arg, prio, sanity_itvl, stack_bottom, stack_size);
|
||||
}
|
||||
|
||||
static inline ble_npl_time_t
|
||||
ble_npl_time_get(void)
|
||||
{
|
||||
|
@@ -71,6 +71,11 @@ ble_npl_time_t npl_tencentos_tiny_callout_get_ticks(struct ble_npl_callout *co);
|
||||
ble_npl_time_t npl_tencentos_tiny_callout_remaining_ticks(struct ble_npl_callout *co,
|
||||
ble_npl_time_t now);
|
||||
|
||||
ble_npl_error_t
|
||||
npl_tencentos_tiny_task_init(struct ble_npl_task *task, char *name, ble_npl_task_entry_t entry,
|
||||
void *arg, uint8_t prio, ble_npl_time_t sanity_itvl,
|
||||
ble_npl_stack_t *stack_bottom, uint16_t stack_size);
|
||||
|
||||
ble_npl_error_t npl_tencentos_tiny_time_ms_to_ticks(uint32_t ms,
|
||||
ble_npl_time_t *out_ticks);
|
||||
|
||||
|
@@ -225,6 +225,19 @@ os_callout_timer_cb(void *arg)
|
||||
}
|
||||
}
|
||||
|
||||
ble_npl_error_t
|
||||
npl_tencentos_tiny_task_init(struct ble_npl_task *task, char *name, ble_npl_task_entry_t entry,
|
||||
void *arg, uint8_t prio, ble_npl_time_t sanity_itvl,
|
||||
ble_npl_stack_t *stack_bottom, uint16_t stack_size)
|
||||
{
|
||||
k_err_t err;
|
||||
|
||||
err = tos_task_create(&task->handle, name, entry, arg, prio, stack_bottom, stack_size, 0);
|
||||
assert(err == K_ERR_NONE);
|
||||
|
||||
return BLE_NPL_OK;
|
||||
}
|
||||
|
||||
void
|
||||
npl_tencentos_tiny_callout_init(struct ble_npl_callout *co, struct ble_npl_eventq *evq,
|
||||
ble_npl_event_fn *ev_cb, void *ev_arg)
|
||||
|
40
components/encoding/base64/include/base64/base64.h
Normal file
40
components/encoding/base64/include/base64/base64.h
Normal file
@@ -0,0 +1,40 @@
|
||||
/*
|
||||
* Licensed to the Apache Software Foundation (ASF) under one
|
||||
* or more contributor license agreements. See the NOTICE file
|
||||
* distributed with this work for additional information
|
||||
* regarding copyright ownership. The ASF licenses this file
|
||||
* to you under the Apache License, Version 2.0 (the
|
||||
* "License"); you may not use this file except in compliance
|
||||
* with the License. You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing,
|
||||
* software distributed under the License is distributed on an
|
||||
* "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
|
||||
* KIND, either express or implied. See the License for the
|
||||
* specific language governing permissions and limitations
|
||||
* under the License.
|
||||
*/
|
||||
#ifndef __UTIL_BASE64_H
|
||||
#define __UTIL_BASE64_H
|
||||
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
int base64_encode(const void *, int, char *, uint8_t);
|
||||
int base64_decode(const char *, void *buf);
|
||||
int base64_pad(char *, int);
|
||||
int base64_decode_len(const char *str);
|
||||
|
||||
#define BASE64_ENCODE_SIZE(__size) (((((__size) - 1) / 3) * 4) + 4)
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* __UTIL_BASE64_H__ */
|
33
components/encoding/base64/include/base64/hex.h
Normal file
33
components/encoding/base64/include/base64/hex.h
Normal file
@@ -0,0 +1,33 @@
|
||||
/*
|
||||
* Licensed to the Apache Software Foundation (ASF) under one
|
||||
* or more contributor license agreements. See the NOTICE file
|
||||
* distributed with this work for additional information
|
||||
* regarding copyright ownership. The ASF licenses this file
|
||||
* to you under the Apache License, Version 2.0 (the
|
||||
* "License"); you may not use this file except in compliance
|
||||
* with the License. You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing,
|
||||
* software distributed under the License is distributed on an
|
||||
* "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
|
||||
* KIND, either express or implied. See the License for the
|
||||
* specific language governing permissions and limitations
|
||||
* under the License.
|
||||
*/
|
||||
#ifndef _UTIL_HEX_H_
|
||||
#define _UTIL_HEX_H_
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
char *hex_format(void *src_v, int src_len, char *dst, int dst_len);
|
||||
int hex_parse(const char *src, int src_len, void *dst_v, int dst_len);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* _UTIL_HEX_H_ */
|
181
components/encoding/base64/src/base64.c
Normal file
181
components/encoding/base64/src/base64.c
Normal file
@@ -0,0 +1,181 @@
|
||||
/*
|
||||
* This file is based on roken from the FreeBSD source. It has been modified
|
||||
* to not use malloc() and instead expect static buffers, and tabs have been
|
||||
* replaced with spaces. Also, instead of strlen() on the resulting string,
|
||||
* pointer arithmitic is done, as p represents the end of the buffer.
|
||||
*/
|
||||
|
||||
/*
|
||||
* Copyright (c) 1995-2001 Kungliga Tekniska Högskolan
|
||||
* (Royal Institute of Technology, Stockholm, Sweden).
|
||||
* All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
*
|
||||
* 2. 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.
|
||||
*
|
||||
* 3. Neither the name of the Institute 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 INSTITUTE 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 INSTITUTE 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 <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
#include <stdio.h>
|
||||
|
||||
#include <base64/base64.h>
|
||||
|
||||
static const char base64_chars[] =
|
||||
"ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
|
||||
|
||||
static int
|
||||
pos(char c)
|
||||
{
|
||||
const char *p;
|
||||
for (p = base64_chars; *p; p++)
|
||||
if (*p == c)
|
||||
return p - base64_chars;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int
|
||||
base64_encode(const void *data, int size, char *s, uint8_t should_pad)
|
||||
{
|
||||
char *p;
|
||||
int i;
|
||||
int c;
|
||||
const unsigned char *q;
|
||||
char *last;
|
||||
int diff;
|
||||
|
||||
p = s;
|
||||
|
||||
q = (const unsigned char *) data;
|
||||
last = NULL;
|
||||
i = 0;
|
||||
while (i < size) {
|
||||
c = q[i++];
|
||||
c *= 256;
|
||||
if (i < size)
|
||||
c += q[i];
|
||||
i++;
|
||||
c *= 256;
|
||||
if (i < size)
|
||||
c += q[i];
|
||||
i++;
|
||||
p[0] = base64_chars[(c & 0x00fc0000) >> 18];
|
||||
p[1] = base64_chars[(c & 0x0003f000) >> 12];
|
||||
p[2] = base64_chars[(c & 0x00000fc0) >> 6];
|
||||
p[3] = base64_chars[(c & 0x0000003f) >> 0];
|
||||
last = p;
|
||||
p += 4;
|
||||
}
|
||||
|
||||
if (last) {
|
||||
diff = i - size;
|
||||
if (diff > 0) {
|
||||
if (should_pad) {
|
||||
memset(last + (4 - diff), '=', diff);
|
||||
} else {
|
||||
p = last + (4 - diff);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
*p = 0;
|
||||
|
||||
return (p - s);
|
||||
}
|
||||
|
||||
int
|
||||
base64_pad(char *buf, int len)
|
||||
{
|
||||
int remainder;
|
||||
|
||||
remainder = len % 4;
|
||||
if (remainder == 0) {
|
||||
return (0);
|
||||
}
|
||||
|
||||
memset(buf, '=', 4 - remainder);
|
||||
|
||||
return (4 - remainder);
|
||||
}
|
||||
|
||||
#define DECODE_ERROR -1
|
||||
|
||||
static unsigned int
|
||||
token_decode(const char *token)
|
||||
{
|
||||
int i;
|
||||
unsigned int val = 0;
|
||||
int marker = 0;
|
||||
if (strlen(token) < 4)
|
||||
return DECODE_ERROR;
|
||||
for (i = 0; i < 4; i++) {
|
||||
val *= 64;
|
||||
if (token[i] == '=')
|
||||
marker++;
|
||||
else if (marker > 0)
|
||||
return DECODE_ERROR;
|
||||
else
|
||||
val += pos(token[i]);
|
||||
}
|
||||
if (marker > 2)
|
||||
return DECODE_ERROR;
|
||||
return (marker << 24) | val;
|
||||
}
|
||||
|
||||
int
|
||||
base64_decode(const char *str, void *data)
|
||||
{
|
||||
const char *p;
|
||||
unsigned char *q;
|
||||
|
||||
q = data;
|
||||
for (p = str; *p && (*p == '=' || strchr(base64_chars, *p)); p += 4) {
|
||||
unsigned int val = token_decode(p);
|
||||
unsigned int marker = (val >> 24) & 0xff;
|
||||
if (val == DECODE_ERROR)
|
||||
return -1;
|
||||
*q++ = (val >> 16) & 0xff;
|
||||
if (marker < 2)
|
||||
*q++ = (val >> 8) & 0xff;
|
||||
if (marker < 1)
|
||||
*q++ = val & 0xff;
|
||||
}
|
||||
return q - (unsigned char *) data;
|
||||
}
|
||||
|
||||
|
||||
int
|
||||
base64_decode_len(const char *str)
|
||||
{
|
||||
int len;
|
||||
|
||||
len = strlen(str);
|
||||
while (len && str[len - 1] == '=') {
|
||||
len--;
|
||||
}
|
||||
return len * 3 / 4;
|
||||
}
|
101
components/encoding/base64/src/hex.c
Normal file
101
components/encoding/base64/src/hex.c
Normal file
@@ -0,0 +1,101 @@
|
||||
/*
|
||||
* Licensed to the Apache Software Foundation (ASF) under one
|
||||
* or more contributor license agreements. See the NOTICE file
|
||||
* distributed with this work for additional information
|
||||
* regarding copyright ownership. The ASF licenses this file
|
||||
* to you under the Apache License, Version 2.0 (the
|
||||
* "License"); you may not use this file except in compliance
|
||||
* with the License. You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing,
|
||||
* software distributed under the License is distributed on an
|
||||
* "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
|
||||
* KIND, either express or implied. See the License for the
|
||||
* specific language governing permissions and limitations
|
||||
* under the License.
|
||||
*/
|
||||
|
||||
#include <inttypes.h>
|
||||
#include <ctype.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#include "base64/hex.h"
|
||||
|
||||
static const char hex_bytes[] = "0123456789abcdef";
|
||||
|
||||
/*
|
||||
* Turn byte array into a printable array. I.e. "\x01" -> "01"
|
||||
*
|
||||
* @param src_v Data to convert
|
||||
* @param src_len Number of bytes of input
|
||||
* @param dst String where to place the results
|
||||
* @param dst_len Size of the target string
|
||||
*
|
||||
* @return Pointer to 'dst' if successful; NULL on failure
|
||||
*/
|
||||
char *
|
||||
hex_format(void *src_v, int src_len, char *dst, int dst_len)
|
||||
{
|
||||
int i;
|
||||
uint8_t *src = (uint8_t *)src_v;
|
||||
char *tgt = dst;
|
||||
|
||||
if (dst_len <= src_len * 2) {
|
||||
return NULL;
|
||||
}
|
||||
for (i = 0; i < src_len; i++) {
|
||||
tgt[0] = hex_bytes[(src[i] >> 4) & 0xf];
|
||||
tgt[1] = hex_bytes[src[i] & 0xf];
|
||||
tgt += 2;
|
||||
dst_len -= 2;
|
||||
}
|
||||
*tgt = '\0';
|
||||
return dst;
|
||||
}
|
||||
|
||||
/*
|
||||
* Turn string of hex decimals into a byte array. I.e. "01" -> "\x01
|
||||
*
|
||||
* @param src String to convert
|
||||
* @param src_len Number of bytes in input string
|
||||
* @param dst_v Memory location to place the result
|
||||
* @param dst_len Amount of space for the result
|
||||
*
|
||||
* @return -1 on failure; number of bytes of input
|
||||
*/
|
||||
int
|
||||
hex_parse(const char *src, int src_len, void *dst_v, int dst_len)
|
||||
{
|
||||
int i;
|
||||
uint8_t *dst = (uint8_t *)dst_v;
|
||||
char c;
|
||||
|
||||
if (src_len & 0x1) {
|
||||
return -1;
|
||||
}
|
||||
if (dst_len * 2 < src_len) {
|
||||
return -1;
|
||||
}
|
||||
for (i = 0; i < src_len; i++, src++) {
|
||||
c = *src;
|
||||
if (isdigit((int) c)) {
|
||||
c -= '0';
|
||||
} else if (c >= 'a' && c <= 'f') {
|
||||
c -= ('a' - 10);
|
||||
} else if (c >= 'A' && c <= 'F') {
|
||||
c -= ('A' - 10);
|
||||
} else {
|
||||
return -1;
|
||||
}
|
||||
if (i & 1) {
|
||||
*dst |= c;
|
||||
dst++;
|
||||
dst_len--;
|
||||
} else {
|
||||
*dst = c << 4;
|
||||
}
|
||||
}
|
||||
return src_len >> 1;
|
||||
}
|
Reference in New Issue
Block a user