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
113
114
115
|
/*
* Copyright 2022 Frederico de Oliveira Linhares
*
* Licensed 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.
*/
#define _USE_MATH_DEFINES
#include "rotation_3d.hpp"
#include "vector_3d.hpp"
namespace
{
inline float
pitch_limit(float pitch)
{
if(pitch > M_PI/2) pitch = M_PI/2;
else if (pitch < -(M_PI/2)) pitch = -(M_PI/2);
return pitch;
}
}
void
cg_free_rotation_3d(mrb_state *mrb, void* obj)
{
auto ptr = static_cast<std::shared_ptr<glm::vec3>*>(obj);
ptr->~shared_ptr();
mrb_free(mrb, ptr);
}
const struct mrb_data_type cg_rotation_3d_type = {
"CG_Rotation3D", cg_free_rotation_3d};
static mrb_value
cg_cRotation3D_initialize(mrb_state *mrb, mrb_value self)
{
mrb_float pitch, yaw, roll;
std::shared_ptr<glm::vec3> *ptr;
mrb_get_args(mrb, "fff", &pitch, &yaw, &roll);
ptr = (std::shared_ptr<glm::vec3>*)DATA_PTR(self);
if(ptr) mrb_free(mrb, ptr);
ptr = (std::shared_ptr<glm::vec3>*)mrb_malloc(
mrb, sizeof(std::shared_ptr<glm::vec3>));
new(ptr)std::shared_ptr<glm::vec3>(
std::make_shared<glm::vec3>(pitch_limit(pitch), yaw, roll));
mrb_data_init(self, ptr, &cg_rotation_3d_type);
return self;
}
// Rotation when there is a up direction (ex.: Earth).
static mrb_value
cg_cRotation3D_rotate(mrb_state *mrb, mrb_value self)
{
mrb_float pitch, yaw;
auto *ptr = (std::shared_ptr<glm::vec3>*)DATA_PTR(self);
mrb_get_args(mrb, "ff", &pitch, &yaw);
(*ptr)->x = pitch_limit((*ptr)->x + pitch);
(*ptr)->y += yaw;
return self;
}
// Rotation when there is a up direction (ex.: space without gravity).
static mrb_value
cg_cRotation3D_baseless_rotation(mrb_state *mrb, mrb_value self)
{
mrb_float x, y;
// TODO
return self;
}
void
cg_rotation_3d_init(mrb_state *mrb)
{
struct RClass *cg_m, *cg_cRotation3D;
cg_m = mrb_module_get(mrb, "CandyGear");
cg_cRotation3D = mrb_define_class_under(
mrb, cg_m, "Rotation3D", mrb->object_class);
MRB_SET_INSTANCE_TT(cg_cRotation3D, MRB_TT_DATA);
mrb_define_method(
mrb, cg_cRotation3D, "initialize", cg_cRotation3D_initialize,
MRB_ARGS_REQ(3));
mrb_define_method(
mrb, cg_cRotation3D, "pitch", cg_cVector3D_get_x, MRB_ARGS_NONE());
mrb_define_method(
mrb, cg_cRotation3D, "yaw", cg_cVector3D_get_y, MRB_ARGS_NONE());
mrb_define_method(
mrb, cg_cRotation3D, "roll", cg_cVector3D_get_z, MRB_ARGS_NONE());
mrb_define_method(
mrb, cg_cRotation3D, "rotate", cg_cRotation3D_rotate, MRB_ARGS_REQ(2));
}
|
