Home /Modules/cdma/cdma_common.c

cdma_common.c

cdma/common/src/cdma_common.c · 66 line(s) · c

/* SPDX-License-Identifier: MIT */
#include "../include/cdma_common.h"
#include <limits.h>
int cdma_walsh_code(int *code, size_t length, unsigned index) {
    size_t i;
    if (!code || length == 0 || (length & (length - 1U)) != 0 || index >= length) return -1;
    for (i = 0; i < length; ++i) {
        unsigned v = (unsigned)i & index, parity = 0;
        while (v) { parity ^= v & 1U; v >>= 1U; }
        code[i] = parity ? -1 : 1;
    }
    return 0;
}
int cdma_ovsf_code(int *code, size_t sf, unsigned index) {
    size_t i, half;
    int lower[512];
    if (!code || sf < 2 || sf > 512 || (sf & (sf - 1U)) != 0 || index >= sf) return -1;
    if (sf == 2) { code[0] = 1; code[1] = index ? -1 : 1; return 0; }
    half = sf / 2;
    if (cdma_ovsf_code(lower, half, index % half) != 0) return -1;
    for (i = 0; i < half; ++i) {
        code[i] = lower[i];
        code[i + half] = index < half ? lower[i] : -lower[i];
    }
    return 0;
}
int cdma_pn_sequence(int *out, size_t length, unsigned stages, unsigned taps, unsigned seed) {
    size_t i; unsigned mask, state;
    if (!out || stages < 2 || stages > 30 || taps == 0) return -1;
    mask = (1U << stages) - 1U;
    /* Taps must reference only existing stages; a tap bit outside the register
     * silently feeds back a nonexistent stage and yields a degenerate sequence. */
    if ((taps & ~mask) != 0U) return -1;
    state = seed & mask; if (!state) state = 1U;
    for (i = 0; i < length; ++i) {
        unsigned fb = 0, x = state & taps;
        while (x) { fb ^= x & 1U; x >>= 1U; }
        out[i] = (state & 1U) ? 1 : -1;
        state = ((state >> 1U) | (fb << (stages - 1U))) & mask;
    }
    return 0;
}
int cdma_spread_symbol(int *chips, size_t length, int symbol, const int *code) {
    size_t i;
    if (!chips || !code || length == 0 || (symbol != 1 && symbol != -1)) return -1;
    for (i = 0; i < length; ++i) chips[i] = symbol * code[i];
    return 0;
}
long cdma_correlate(const int *rx, size_t length, const int *code) {
    size_t i; long sum = 0;
    if (!rx || !code) return LONG_MIN;
    for (i = 0; i < length; ++i) sum += (long)rx[i] * code[i];
    return sum;
}
int cdma_decide_symbol(long correlation) { return correlation < 0 ? -1 : 1; }
int cdma_channel_add(int *channel, size_t length, const int *user) {
    size_t i;
    if (!channel || !user) return -1;
    for (i = 0; i < length; ++i) channel[i] += user[i];
    return 0;
}
void cdma_channel_clear(int *channel, size_t length) {
    size_t i;
    if (channel) for (i = 0; i < length; ++i) channel[i] = 0;
}