-
Notifications
You must be signed in to change notification settings - Fork 125
/
_msg_support.entry_point.c.em
162 lines (151 loc) · 4.54 KB
/
_msg_support.entry_point.c.em
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
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
// generated from rosidl_generator_py/resource/_msg_support.entry_point.c.em
// generated code does not contain a copyright notice
#include <Python.h>
#include <stdint.h>
@{
static_includes = {}
for spec, subfolder in message_specs:
if subfolder == 'msg':
static_includes[subfolder] = '#include <rosidl_generator_c/message_type_support.h>'
elif subfolder == 'srv':
static_includes[subfolder] = '#include <rosidl_generator_c/service_type_support.h>'
}@
@[for value in sorted(static_includes.values())]@
@(value)
@[end for]@
@{
includes = {}
for spec, subfolder in message_specs:
type_name = spec.base_type.type
module_name = convert_camel_case_to_lower_case_underscore(type_name)
key = '%s/%s/%s' % (spec.base_type.pkg_name, subfolder, module_name)
includes[key] = '#include <%s__type_support.h>' % key
for spec, subfolder in service_specs:
type_name = convert_camel_case_to_lower_case_underscore(spec.srv_name)
module_name = convert_camel_case_to_lower_case_underscore(type_name)
key = '%s/%s/%s' % (spec.pkg_name, subfolder, module_name)
includes[key] = '#include <%s.h>' % key
}@
@[for v in sorted(includes.values())]@
@(v)
@[end for]@
@[for spec, subfolder in message_specs]@
@{
type_name = spec.base_type.type
module_name = convert_camel_case_to_lower_case_underscore(type_name)
}@
void * @(spec.base_type.pkg_name)_@(module_name)__convert_from_py(PyObject * _pymsg);
PyObject * @(spec.base_type.pkg_name)_@(module_name)__convert_to_py(void * raw_ros_message);
@[end for]@
static PyMethodDef @(package_name)__methods[] = {
{NULL, NULL, 0, NULL} /* sentinel */
};
static struct PyModuleDef @(package_name)__module = {
PyModuleDef_HEAD_INIT,
"_@(package_name)_support",
"_@(package_name)_doc",
-1, /* -1 means that the module keeps state in global variables */
@(package_name)__methods,
NULL,
NULL,
NULL,
NULL,
};
@
@[for spec, subfolder in message_specs]@
@{
type_name = convert_camel_case_to_lower_case_underscore(spec.base_type.type)
function_names = ['convert_from_py', 'convert_to_py', 'type_support']
}@
int8_t
_register_msg_type__@(type_name)(PyObject * pymodule)
{
int8_t err;
@[ for function_name in function_names]@
PyObject * pyobject_@(function_name) = NULL;
pyobject_@(function_name) = PyCapsule_New(
@[ if function_name != 'type_support']@
(void *)&@(spec.base_type.pkg_name)_@(type_name)__@(function_name),
@[ else]@
(void *)ROSIDL_GET_TYPE_SUPPORT(@(spec.base_type.pkg_name), @(subfolder), @(spec.msg_name)),
@[ end if]@
NULL, NULL);
if (!pyobject_@(function_name)) {
// previously added objects will be removed when the module is destroyed
return -1;
}
err = PyModule_AddObject(
pymodule,
"@(function_name)_msg_@(type_name)",
pyobject_@(function_name));
if (err) {
// the created capsule needs to be decremented
Py_XDECREF(pyobject_@(function_name));
// previously added objects will be removed when the module is destroyed
return err;
}
@[ end for]@
return 0;
}
@[end for]@
@[for spec, subfolder in service_specs]@
@{
type_name = convert_camel_case_to_lower_case_underscore(spec.srv_name)
function_name = 'type_support'
}@
int8_t
_register_srv_type__@(type_name)(PyObject * pymodule)
{
int8_t err;
PyObject * pyobject_@(function_name) = NULL;
pyobject_@(function_name) = PyCapsule_New(
(void *)ROSIDL_GET_TYPE_SUPPORT_FUNCTION(@(spec.pkg_name), srv, @(spec.srv_name))(),
NULL, NULL);
if (!pyobject_@(function_name)) {
// previously added objects will be removed when the module is destroyed
return -1;
}
err = PyModule_AddObject(
pymodule,
"@(function_name)_srv_@(type_name)",
pyobject_@(function_name));
if (err) {
// the created capsule needs to be decremented
Py_XDECREF(pyobject_@(function_name));
// previously added objects will be removed when the module is destroyed
return err;
}
return 0;
}
@[end for]@
PyMODINIT_FUNC
PyInit_@(package_name)_s__@(typesupport_impl)(void)
{
PyObject * pymodule = NULL;
pymodule = PyModule_Create(&@(package_name)__module);
if (!pymodule) {
return NULL;
}
int8_t err;
@[for spec, subfolder in message_specs]@
@{
type_name = convert_camel_case_to_lower_case_underscore(spec.base_type.type)
}@
err = _register_msg_type__@(type_name)(pymodule);
if (err) {
Py_XDECREF(pymodule);
return NULL;
}
@[end for]@
@[for spec, subfolder in service_specs]@
@{
type_name = convert_camel_case_to_lower_case_underscore(spec.srv_name)
}@
err = _register_srv_type__@(type_name)(pymodule);
if (err) {
Py_XDECREF(pymodule);
return NULL;
}
@[end for]@
return pymodule;
}