1/*****************************************************************************\
2 Snes9x - Portable Super Nintendo Entertainment System (TM) emulator.
3 This file is licensed under the Snes9x License.
4 For further information, consult the LICENSE file in the root directory.
5\*****************************************************************************/
6
7#include <math.h>
8#include "snes9x.h"
9#include "memmap.h"
10
11#define C4_PI 3.14159265
12
13int16 C4WFXVal;
14int16 C4WFYVal;
15int16 C4WFZVal;
16int16 C4WFX2Val;
17int16 C4WFY2Val;
18int16 C4WFDist;
19int16 C4WFScale;
20int16 C41FXVal;
21int16 C41FYVal;
22int16 C41FAngleRes;
23int16 C41FDist;
24int16 C41FDistVal;
25
26static double tanval;
27static double c4x, c4y, c4z;
28static double c4x2, c4y2, c4z2;
29
30
31void C4TransfWireFrame (void)
32{
33 c4x = (double) C4WFXVal;
34 c4y = (double) C4WFYVal;
35 c4z = (double) C4WFZVal - 0x95;
36
37 // Rotate X
38 tanval = -(double) C4WFX2Val * C4_PI * 2 / 128;
39 c4y2 = c4y * cos(tanval) - c4z * sin(tanval);
40 c4z2 = c4y * sin(tanval) + c4z * cos(tanval);
41
42 // Rotate Y
43 tanval = -(double) C4WFY2Val * C4_PI * 2 / 128;
44 c4x2 = c4x * cos(tanval) + c4z2 * sin(tanval);
45 c4z = c4x * -sin(tanval) + c4z2 * cos(tanval);
46
47 // Rotate Z
48 tanval = -(double) C4WFDist * C4_PI * 2 / 128;
49 c4x = c4x2 * cos(tanval) - c4y2 * sin(tanval);
50 c4y = c4x2 * sin(tanval) + c4y2 * cos(tanval);
51
52 // Scale
53 C4WFXVal = (int16) (c4x * (double) C4WFScale / (0x90 * (c4z + 0x95)) * 0x95);
54 C4WFYVal = (int16) (c4y * (double) C4WFScale / (0x90 * (c4z + 0x95)) * 0x95);
55}
56
57void C4TransfWireFrame2 (void)
58{
59 c4x = (double) C4WFXVal;
60 c4y = (double) C4WFYVal;
61 c4z = (double) C4WFZVal;
62
63 // Rotate X
64 tanval = -(double) C4WFX2Val * C4_PI * 2 / 128;
65 c4y2 = c4y * cos(tanval) - c4z * sin(tanval);
66 c4z2 = c4y * sin(tanval) + c4z * cos(tanval);
67
68 // Rotate Y
69 tanval = -(double) C4WFY2Val * C4_PI * 2 / 128;
70 c4x2 = c4x * cos(tanval) + c4z2 * sin(tanval);
71 c4z = c4x * -sin(tanval) + c4z2 * cos(tanval);
72
73 // Rotate Z
74 tanval = -(double) C4WFDist * C4_PI * 2 / 128;
75 c4x = c4x2 * cos(tanval) - c4y2 * sin(tanval);
76 c4y = c4x2 * sin(tanval) + c4y2 * cos(tanval);
77
78 // Scale
79 C4WFXVal = (int16) (c4x * (double) C4WFScale / 0x100);
80 C4WFYVal = (int16) (c4y * (double) C4WFScale / 0x100);
81}
82
83void C4CalcWireFrame (void)
84{
85 C4WFXVal = C4WFX2Val - C4WFXVal;
86 C4WFYVal = C4WFY2Val - C4WFYVal;
87
88 if (abs(C4WFXVal) > abs(C4WFYVal))
89 {
90 C4WFDist = abs(C4WFXVal) + 1;
91 C4WFYVal = (int16) (256 * (double) C4WFYVal / abs(C4WFXVal));
92 if (C4WFXVal < 0)
93 C4WFXVal = -256;
94 else
95 C4WFXVal = 256;
96 }
97 else
98 {
99 if (C4WFYVal != 0)
100 {
101 C4WFDist = abs(C4WFYVal) + 1;
102 C4WFXVal = (int16) (256 * (double) C4WFXVal / abs(C4WFYVal));
103 if (C4WFYVal < 0)
104 C4WFYVal = -256;
105 else
106 C4WFYVal = 256;
107 }
108 else
109 C4WFDist = 0;
110 }
111}
112
113void C4Op1F (void)
114{
115 if (C41FXVal == 0)
116 {
117 if (C41FYVal > 0)
118 C41FAngleRes = 0x80;
119 else
120 C41FAngleRes = 0x180;
121 }
122 else
123 {
124 tanval = (double) C41FYVal / C41FXVal;
125 C41FAngleRes = (int16) (atan(tanval) / (C4_PI * 2) * 512);
126 if (C41FXVal< 0)
127 C41FAngleRes += 0x100;
128 C41FAngleRes &= 0x1FF;
129 }
130}
131
132void C4Op15 (void)
133{
134 tanval = sqrt((double) C41FYVal * C41FYVal + (double) C41FXVal * C41FXVal);
135 C41FDist = (int16) tanval;
136}
137
138void C4Op0D (void)
139{
140 tanval = sqrt((double) C41FYVal * C41FYVal + (double) C41FXVal * C41FXVal);
141 tanval = C41FDistVal / tanval;
142 C41FYVal = (int16) (C41FYVal * tanval * 0.99);
143 C41FXVal = (int16) (C41FXVal * tanval * 0.98);
144}
145
146uint8 * S9xGetBasePointerC4 (uint16 Address)
147{
148 if (Address >= 0x7f40 && Address <= 0x7f5e)
149 return (NULL);
150 return (Memory.C4RAM - 0x6000);
151}
152
153uint8 * S9xGetMemPointerC4 (uint16 Address)
154{
155 if (Address >= 0x7f40 && Address <= 0x7f5e)
156 return (NULL);
157 return (Memory.C4RAM - 0x6000 + (Address & 0xffff));
158}
159