init 5.10_rt with nkio nkmcu

hc

2023-12-06 d38611ca164021d018c1b23eee65bbebc09c63e0

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
// SPDX-License-Identifier: GPL-2.0-or-later
/*
    NetWinder Floating Point Emulator
    (c) Rebel.COM, 1998,1999
    (c) Philip Blundell, 2001
 
    Direct questions, comments to Scott Bambrough <scottb@netwinder.org>
 
*/
 
#include "fpa11.h"
#include "softfloat.h"
#include "fpopcode.h"
 
float32 float32_exp(float32 Fm);
float32 float32_ln(float32 Fm);
float32 float32_sin(float32 rFm);
float32 float32_cos(float32 rFm);
float32 float32_arcsin(float32 rFm);
float32 float32_arctan(float32 rFm);
float32 float32_log(float32 rFm);
float32 float32_tan(float32 rFm);
float32 float32_arccos(float32 rFm);
float32 float32_pow(float32 rFn, float32 rFm);
float32 float32_pol(float32 rFn, float32 rFm);
 
static float32 float32_rsf(struct roundingData *roundData, float32 rFn, float32 rFm)
{
    return float32_sub(roundData, rFm, rFn);
}
 
static float32 float32_rdv(struct roundingData *roundData, float32 rFn, float32 rFm)
{
    return float32_div(roundData, rFm, rFn);
}
 
static float32 (*const dyadic_single[16])(struct roundingData *, float32 rFn, float32 rFm) = {
    [ADF_CODE >> 20] = float32_add,
    [MUF_CODE >> 20] = float32_mul,
    [SUF_CODE >> 20] = float32_sub,
    [RSF_CODE >> 20] = float32_rsf,
    [DVF_CODE >> 20] = float32_div,
    [RDF_CODE >> 20] = float32_rdv,
    [RMF_CODE >> 20] = float32_rem,
 
    [FML_CODE >> 20] = float32_mul,
    [FDV_CODE >> 20] = float32_div,
    [FRD_CODE >> 20] = float32_rdv,
};
 
static float32 float32_mvf(struct roundingData *roundData, float32 rFm)
{
    return rFm;
}
 
static float32 float32_mnf(struct roundingData *roundData, float32 rFm)
{
    return rFm ^ 0x80000000;
}
 
static float32 float32_abs(struct roundingData *roundData, float32 rFm)
{
    return rFm & 0x7fffffff;
}
 
static float32 (*const monadic_single[16])(struct roundingData*, float32 rFm) = {
    [MVF_CODE >> 20] = float32_mvf,
    [MNF_CODE >> 20] = float32_mnf,
    [ABS_CODE >> 20] = float32_abs,
    [RND_CODE >> 20] = float32_round_to_int,
    [URD_CODE >> 20] = float32_round_to_int,
    [SQT_CODE >> 20] = float32_sqrt,
    [NRM_CODE >> 20] = float32_mvf,
};
 
unsigned int SingleCPDO(struct roundingData *roundData, const unsigned int opcode, FPREG * rFd)
{
    FPA11 *fpa11 = GET_FPA11();
    float32 rFm;
    unsigned int Fm, opc_mask_shift;
 
    Fm = getFm(opcode);
    if (CONSTANT_FM(opcode)) {
        rFm = getSingleConstant(Fm);
    } else if (fpa11->fType[Fm] == typeSingle) {
        rFm = fpa11->fpreg[Fm].fSingle;
    } else {
        return 0;
    }
 
    opc_mask_shift = (opcode & MASK_ARITHMETIC_OPCODE) >> 20;
    if (!MONADIC_INSTRUCTION(opcode)) {
        unsigned int Fn = getFn(opcode);
        float32 rFn;
 
        if (fpa11->fType[Fn] == typeSingle &&
            dyadic_single[opc_mask_shift]) {
            rFn = fpa11->fpreg[Fn].fSingle;
            rFd->fSingle = dyadic_single[opc_mask_shift](roundData, rFn, rFm);
        } else {
            return 0;
        }
    } else {
        if (monadic_single[opc_mask_shift]) {
            rFd->fSingle = monadic_single[opc_mask_shift](roundData, rFm);
        } else {
            return 0;
        }
    }
 
    return 1;
}