mirror of https://github.com/probonopd/MiniDexed
probonopd
2 months ago
committed by
GitHub
commit
ecbae30c03
@ -0,0 +1,88 @@ |
|||||||
|
#include "arm_float_to_q23.h" |
||||||
|
|
||||||
|
#if defined(ARM_MATH_NEON_EXPERIMENTAL) |
||||||
|
void arm_float_to_q23(const float32_t * pSrc, q23_t * pDst, uint32_t blockSize) |
||||||
|
{ |
||||||
|
const float32_t *pIn = pSrc; /* Src pointer */ |
||||||
|
uint32_t blkCnt; /* loop counter */ |
||||||
|
|
||||||
|
float32x4_t inV; |
||||||
|
|
||||||
|
int32x4_t cvt; |
||||||
|
|
||||||
|
blkCnt = blockSize >> 2U; |
||||||
|
|
||||||
|
/* Compute 4 outputs at a time.
|
||||||
|
** a second loop below computes the remaining 1 to 3 samples. */ |
||||||
|
while (blkCnt > 0U) |
||||||
|
{ |
||||||
|
/* C = A * 8388608 */ |
||||||
|
/* Convert from float to q23 and then store the results in the destination buffer */ |
||||||
|
inV = vld1q_f32(pIn); |
||||||
|
|
||||||
|
cvt = vcvtq_n_s32_f32(inV, 23); |
||||||
|
|
||||||
|
/* saturate */ |
||||||
|
cvt = vminq_s32(cvt, vdupq_n_s32(0x007fffff)); |
||||||
|
cvt = vmaxq_s32(cvt, vdupq_n_s32(0xff800000)); |
||||||
|
|
||||||
|
vst1q_s32(pDst, cvt); |
||||||
|
pDst += 4; |
||||||
|
pIn += 4; |
||||||
|
|
||||||
|
/* Decrement the loop counter */ |
||||||
|
blkCnt--; |
||||||
|
} |
||||||
|
|
||||||
|
/* If the blockSize is not a multiple of 4, compute any remaining output samples here.
|
||||||
|
** No loop unrolling is used. */ |
||||||
|
blkCnt = blockSize & 3; |
||||||
|
|
||||||
|
while (blkCnt > 0U) |
||||||
|
{ |
||||||
|
/* C = A * 8388608 */ |
||||||
|
/* Convert from float to q23 and then store the results in the destination buffer */ |
||||||
|
*pDst++ = (q23_t) __SSAT((q31_t) (*pIn++ * 8388608.0f), 24); |
||||||
|
|
||||||
|
/* Decrement the loop counter */ |
||||||
|
blkCnt--; |
||||||
|
} |
||||||
|
} |
||||||
|
#else |
||||||
|
void arm_float_to_q23(const float32_t * pSrc, q23_t * pDst, uint32_t blockSize) |
||||||
|
{ |
||||||
|
uint32_t blkCnt; /* Loop counter */ |
||||||
|
const float32_t *pIn = pSrc; /* Source pointer */ |
||||||
|
|
||||||
|
/* Loop unrolling: Compute 4 outputs at a time */ |
||||||
|
blkCnt = blockSize >> 2U; |
||||||
|
|
||||||
|
while (blkCnt > 0U) |
||||||
|
{ |
||||||
|
/* C = A * 8388608 */ |
||||||
|
/* convert from float to Q23 and store result in destination buffer */ |
||||||
|
|
||||||
|
*pDst++ = (q23_t) __SSAT((q31_t) (*pIn++ * 8388608.0f), 24); |
||||||
|
*pDst++ = (q23_t) __SSAT((q31_t) (*pIn++ * 8388608.0f), 24); |
||||||
|
*pDst++ = (q23_t) __SSAT((q31_t) (*pIn++ * 8388608.0f), 24); |
||||||
|
*pDst++ = (q23_t) __SSAT((q31_t) (*pIn++ * 8388608.0f), 24); |
||||||
|
|
||||||
|
/* Decrement loop counter */ |
||||||
|
blkCnt--; |
||||||
|
} |
||||||
|
|
||||||
|
/* Loop unrolling: Compute remaining outputs */ |
||||||
|
blkCnt = blockSize % 0x4U; |
||||||
|
|
||||||
|
while (blkCnt > 0U) |
||||||
|
{ |
||||||
|
/* C = A * 8388608 */ |
||||||
|
/* Convert from float to q23 and then store the results in the destination buffer */ |
||||||
|
*pDst++ = (q23_t) __SSAT((q31_t) (*pIn++ * 8388608.0f), 24); |
||||||
|
|
||||||
|
/* Decrement loop counter */ |
||||||
|
blkCnt--; |
||||||
|
} |
||||||
|
|
||||||
|
} |
||||||
|
#endif /* #if defined(ARM_MATH_NEON_EXPERIMENTAL) */ |
||||||
@ -0,0 +1,22 @@ |
|||||||
|
#pragma once |
||||||
|
|
||||||
|
#include "arm_math_types.h" |
||||||
|
|
||||||
|
typedef int32_t q23_t; |
||||||
|
|
||||||
|
#ifdef __cplusplus |
||||||
|
extern "C" |
||||||
|
{ |
||||||
|
#endif |
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Converts the elements of the floating-point vector to Q23 vector. |
||||||
|
* @param[in] pSrc points to the floating-point input vector |
||||||
|
* @param[out] pDst points to the Q23 output vector |
||||||
|
* @param[in] blockSize length of the input vector |
||||||
|
*/ |
||||||
|
void arm_float_to_q23(const float32_t * pSrc, q23_t * pDst, uint32_t blockSize); |
||||||
|
|
||||||
|
#ifdef __cplusplus |
||||||
|
} |
||||||
|
#endif |
||||||
@ -0,0 +1,57 @@ |
|||||||
|
#!/usr/bin/env python3 |
||||||
|
# -*- coding: utf-8 -*- |
||||||
|
|
||||||
|
""" |
||||||
|
Syslog server to receive and display syslog messages from MiniDexed. |
||||||
|
""" |
||||||
|
|
||||||
|
import socket |
||||||
|
import time |
||||||
|
import threading |
||||||
|
|
||||||
|
class SyslogServer: |
||||||
|
def __init__(self, host='0.0.0.0', port=8514): |
||||||
|
self.host = host |
||||||
|
self.port = port |
||||||
|
self.server = socket.socket(socket.AF_INET, socket.SOCK_DGRAM) |
||||||
|
self.server.bind((self.host, self.port)) |
||||||
|
self.start_time = None |
||||||
|
self.running = True |
||||||
|
|
||||||
|
def start(self): |
||||||
|
ip_address = socket.gethostbyname(socket.gethostname()) |
||||||
|
print(f"Syslog server listening on {ip_address}:{self.port}") |
||||||
|
input_thread = threading.Thread(target=self.wait_for_input) |
||||||
|
input_thread.daemon = True |
||||||
|
input_thread.start() |
||||||
|
while self.running: |
||||||
|
try: |
||||||
|
data, address = self.server.recvfrom(1024) |
||||||
|
self.handle_message(data) |
||||||
|
except KeyboardInterrupt: |
||||||
|
self.running = False |
||||||
|
|
||||||
|
def handle_message(self, data): |
||||||
|
message = data[2:].decode('utf-8').strip() |
||||||
|
|
||||||
|
if self.start_time is None: |
||||||
|
self.start_time = time.time() |
||||||
|
relative_time = "0:00:00.000" |
||||||
|
else: |
||||||
|
elapsed_time = time.time() - self.start_time |
||||||
|
hours = int(elapsed_time // 3600) |
||||||
|
minutes = int((elapsed_time % 3600) // 60) |
||||||
|
seconds = int(elapsed_time % 60) |
||||||
|
milliseconds = int((elapsed_time % 1) * 1000) |
||||||
|
relative_time = f"{hours:02d}:{minutes:02d}:{seconds:02d}.{milliseconds:03d}" |
||||||
|
|
||||||
|
print(f"{relative_time} {message}") |
||||||
|
|
||||||
|
def wait_for_input(self): |
||||||
|
input("Press any key to exit...") |
||||||
|
self.running = False |
||||||
|
|
||||||
|
if __name__ == "__main__": |
||||||
|
server = SyslogServer() |
||||||
|
server.start() |
||||||
|
print("Syslog server stopped.") |
||||||
Loading…
Reference in new issue