cmsisdsp_support.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062
  1. /* ----------------------------------------------------------------------
  2. * Project: CMSIS DSP Python Wrapper
  3. * Title: cmsismodule.h
  4. * Description: C code for the CMSIS-DSP Python wrapper
  5. *
  6. * $Date: 27 April 2021
  7. * $Revision: V1.0
  8. *
  9. * Target Processor: Cortex-M cores
  10. * -------------------------------------------------------------------- */
  11. /*
  12. * Copyright (C) 2010-2021 ARM Limited or its affiliates. All rights reserved.
  13. *
  14. * SPDX-License-Identifier: Apache-2.0
  15. *
  16. * Licensed under the Apache License, Version 2.0 (the License); you may
  17. * not use this file except in compliance with the License.
  18. * You may obtain a copy of the License at
  19. *
  20. * www.apache.org/licenses/LICENSE-2.0
  21. *
  22. * Unless required by applicable law or agreed to in writing, software
  23. * distributed under the License is distributed on an AS IS BASIS, WITHOUT
  24. * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  25. * See the License for the specific language governing permissions and
  26. * limitations under the License.
  27. */
  28. #define MODNAME "cmsisdsp_support"
  29. #define MODINITNAME cmsisdsp_support
  30. #include "cmsisdsp_module.h"
  31. NUMPYVECTORFROMBUFFER(f32,float32_t,NPY_FLOAT);
  32. typedef struct {
  33. PyObject_HEAD
  34. arm_sort_instance_f32 *instance;
  35. } dsp_arm_sort_instance_f32Object;
  36. static void
  37. arm_sort_instance_f32_dealloc(dsp_arm_sort_instance_f32Object* self)
  38. {
  39. //printf("Dealloc called\n");
  40. if (self->instance)
  41. {
  42. PyMem_Free(self->instance);
  43. }
  44. Py_TYPE(self)->tp_free((PyObject*)self);
  45. }
  46. static PyObject *
  47. arm_sort_instance_f32_new(PyTypeObject *type, PyObject *args, PyObject *kwds)
  48. {
  49. dsp_arm_sort_instance_f32Object *self;
  50. //printf("New called\n");
  51. self = (dsp_arm_sort_instance_f32Object *)type->tp_alloc(type, 0);
  52. //printf("alloc called\n");
  53. if (self != NULL) {
  54. self->instance = PyMem_Malloc(sizeof(arm_sort_instance_f32));
  55. }
  56. return (PyObject *)self;
  57. }
  58. static int
  59. arm_sort_instance_f32_init(dsp_arm_sort_instance_f32Object *self, PyObject *args, PyObject *kwds)
  60. {
  61. PyObject *pState=NULL;
  62. PyObject *pCoeffs=NULL;
  63. char *kwlist[] = {
  64. "arm_sort_alg","arm_sort_dir",NULL
  65. };
  66. uint16_t alg,dir;
  67. if (PyArg_ParseTupleAndKeywords(args, kwds, "|hh", kwlist,&alg,&dir
  68. ))
  69. {
  70. self->instance->alg=alg;
  71. self->instance->dir=dir;
  72. }
  73. return 0;
  74. }
  75. static PyObject *
  76. Method_arm_sort_instance_f32_alg(dsp_arm_sort_instance_f32Object *self, PyObject *ignored)
  77. {
  78. return(Py_BuildValue("i",(int)self->instance->alg));
  79. }
  80. static PyObject *
  81. Method_arm_sort_instance_f32_dir(dsp_arm_sort_instance_f32Object *self, PyObject *ignored)
  82. {
  83. return(Py_BuildValue("i",(int)self->instance->dir));
  84. }
  85. static PyMethodDef arm_sort_instance_f32_methods[] = {
  86. {"alg", (PyCFunction) Method_arm_sort_instance_f32_alg,METH_NOARGS,"alg"},
  87. {"dir", (PyCFunction) Method_arm_sort_instance_f32_dir,METH_NOARGS,"dir"},
  88. {NULL} /* Sentinel */
  89. };
  90. DSPType(arm_sort_instance_f32,arm_sort_instance_f32_new,arm_sort_instance_f32_dealloc,arm_sort_instance_f32_init,arm_sort_instance_f32_methods);
  91. void typeRegistration(PyObject *module) {
  92. ADDTYPE(arm_sort_instance_f32);
  93. }
  94. static PyObject *
  95. cmsis_arm_sort_init_f32(PyObject *obj, PyObject *args)
  96. {
  97. PyObject *S=NULL; // input
  98. uint16_t alg,dir; // input
  99. if (PyArg_ParseTuple(args,"Ohh",&S,&alg,&dir))
  100. {
  101. dsp_arm_sort_instance_f32Object *selfS = (dsp_arm_sort_instance_f32Object *)S;
  102. arm_sort_init_f32(selfS->instance,alg,dir);
  103. Py_RETURN_NONE;
  104. }
  105. return(NULL);
  106. }
  107. static PyObject *
  108. cmsis_arm_sort_f32(PyObject *obj, PyObject *args)
  109. {
  110. PyObject *S=NULL; // input
  111. PyObject *pSrc=NULL; // input
  112. float32_t *pSrc_converted=NULL; // input
  113. float32_t *pDst=NULL; // output
  114. uint32_t blockSize; // input
  115. if (PyArg_ParseTuple(args,"OO",&S,&pSrc))
  116. {
  117. dsp_arm_sort_instance_f32Object *selfS = (dsp_arm_sort_instance_f32Object *)S;
  118. GETARGUMENT(pSrc,NPY_DOUBLE,double,float32_t);
  119. blockSize = arraySizepSrc ;
  120. pDst=PyMem_Malloc(sizeof(float32_t)*blockSize);
  121. arm_sort_f32(selfS->instance,pSrc_converted,pDst,blockSize);
  122. FLOATARRAY1(pDstOBJ,blockSize,pDst);
  123. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  124. FREEARGUMENT(pSrc_converted);
  125. Py_DECREF(pDstOBJ);
  126. return(pythonResult);
  127. }
  128. return(NULL);
  129. }
  130. static PyObject *
  131. cmsis_arm_fill_f32(PyObject *obj, PyObject *args)
  132. {
  133. float32_t value; // input
  134. float32_t *pDst=NULL; // output
  135. uint32_t blockSize; // input
  136. if (PyArg_ParseTuple(args,"fi",&value,&blockSize))
  137. {
  138. pDst=PyMem_Malloc(sizeof(float32_t)*blockSize);
  139. arm_fill_f32(value,pDst,blockSize);
  140. FLOATARRAY1(pDstOBJ,blockSize,pDst);
  141. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  142. Py_DECREF(pDstOBJ);
  143. return(pythonResult);
  144. }
  145. return(NULL);
  146. }
  147. static PyObject *
  148. cmsis_arm_fill_f64(PyObject *obj, PyObject *args)
  149. {
  150. float64_t value; // input
  151. float64_t *pDst=NULL; // output
  152. uint32_t blockSize; // input
  153. if (PyArg_ParseTuple(args,"di",&value,&blockSize))
  154. {
  155. pDst=PyMem_Malloc(sizeof(float64_t)*blockSize);
  156. arm_fill_f64(value,pDst,blockSize);
  157. FLOAT64ARRAY1(pDstOBJ,blockSize,pDst);
  158. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  159. Py_DECREF(pDstOBJ);
  160. return(pythonResult);
  161. }
  162. return(NULL);
  163. }
  164. static PyObject *
  165. cmsis_arm_fill_q31(PyObject *obj, PyObject *args)
  166. {
  167. q31_t value; // input
  168. q31_t *pDst=NULL; // output
  169. uint32_t blockSize; // input
  170. if (PyArg_ParseTuple(args,"ii",&value,&blockSize))
  171. {
  172. pDst=PyMem_Malloc(sizeof(q31_t)*blockSize);
  173. arm_fill_q31(value,pDst,blockSize);
  174. INT32ARRAY1(pDstOBJ,blockSize,pDst);
  175. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  176. Py_DECREF(pDstOBJ);
  177. return(pythonResult);
  178. }
  179. return(NULL);
  180. }
  181. static PyObject *
  182. cmsis_arm_fill_q15(PyObject *obj, PyObject *args)
  183. {
  184. q15_t value; // input
  185. q15_t *pDst=NULL; // output
  186. uint32_t blockSize; // input
  187. if (PyArg_ParseTuple(args,"hi",&value,&blockSize))
  188. {
  189. pDst=PyMem_Malloc(sizeof(q15_t)*blockSize);
  190. arm_fill_q15(value,pDst,blockSize);
  191. INT16ARRAY1(pDstOBJ,blockSize,pDst);
  192. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  193. Py_DECREF(pDstOBJ);
  194. return(pythonResult);
  195. }
  196. return(NULL);
  197. }
  198. static PyObject *
  199. cmsis_arm_fill_q7(PyObject *obj, PyObject *args)
  200. {
  201. q31_t value; // input
  202. q7_t *pDst=NULL; // output
  203. uint32_t blockSize; // input
  204. if (PyArg_ParseTuple(args,"ii",&value,&blockSize))
  205. {
  206. pDst=PyMem_Malloc(sizeof(q7_t)*blockSize);
  207. arm_fill_q7((q7_t)value,pDst,blockSize);
  208. INT8ARRAY1(pDstOBJ,blockSize,pDst);
  209. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  210. Py_DECREF(pDstOBJ);
  211. return(pythonResult);
  212. }
  213. return(NULL);
  214. }
  215. static PyObject *
  216. cmsis_arm_copy_f32(PyObject *obj, PyObject *args)
  217. {
  218. PyObject *pSrc=NULL; // input
  219. float32_t *pSrc_converted=NULL; // input
  220. float32_t *pDst=NULL; // output
  221. uint32_t blockSize; // input
  222. if (PyArg_ParseTuple(args,"O",&pSrc))
  223. {
  224. GETARGUMENT(pSrc,NPY_DOUBLE,double,float32_t);
  225. blockSize = arraySizepSrc ;
  226. pDst=PyMem_Malloc(sizeof(float32_t)*blockSize);
  227. arm_copy_f32(pSrc_converted,pDst,blockSize);
  228. FLOATARRAY1(pDstOBJ,blockSize,pDst);
  229. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  230. FREEARGUMENT(pSrc_converted);
  231. Py_DECREF(pDstOBJ);
  232. return(pythonResult);
  233. }
  234. return(NULL);
  235. }
  236. static PyObject *
  237. cmsis_arm_copy_f64(PyObject *obj, PyObject *args)
  238. {
  239. PyObject *pSrc=NULL; // input
  240. float64_t *pSrc_converted=NULL; // input
  241. float64_t *pDst=NULL; // output
  242. uint32_t blockSize; // input
  243. if (PyArg_ParseTuple(args,"O",&pSrc))
  244. {
  245. GETARGUMENT(pSrc,NPY_DOUBLE,double,float64_t);
  246. blockSize = arraySizepSrc ;
  247. pDst=PyMem_Malloc(sizeof(float64_t)*blockSize);
  248. arm_copy_f64(pSrc_converted,pDst,blockSize);
  249. FLOAT64ARRAY1(pDstOBJ,blockSize,pDst);
  250. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  251. FREEARGUMENT(pSrc_converted);
  252. Py_DECREF(pDstOBJ);
  253. return(pythonResult);
  254. }
  255. return(NULL);
  256. }
  257. static PyObject *
  258. cmsis_arm_copy_q7(PyObject *obj, PyObject *args)
  259. {
  260. PyObject *pSrc=NULL; // input
  261. q7_t *pSrc_converted=NULL; // input
  262. q7_t *pDst=NULL; // output
  263. uint32_t blockSize; // input
  264. if (PyArg_ParseTuple(args,"O",&pSrc))
  265. {
  266. GETARGUMENT(pSrc,NPY_BYTE,int8_t,q7_t);
  267. blockSize = arraySizepSrc ;
  268. pDst=PyMem_Malloc(sizeof(q7_t)*blockSize);
  269. arm_copy_q7(pSrc_converted,pDst,blockSize);
  270. INT8ARRAY1(pDstOBJ,blockSize,pDst);
  271. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  272. FREEARGUMENT(pSrc_converted);
  273. Py_DECREF(pDstOBJ);
  274. return(pythonResult);
  275. }
  276. return(NULL);
  277. }
  278. static PyObject *
  279. cmsis_arm_copy_q15(PyObject *obj, PyObject *args)
  280. {
  281. PyObject *pSrc=NULL; // input
  282. q15_t *pSrc_converted=NULL; // input
  283. q15_t *pDst=NULL; // output
  284. uint32_t blockSize; // input
  285. if (PyArg_ParseTuple(args,"O",&pSrc))
  286. {
  287. GETARGUMENT(pSrc,NPY_INT16,int16_t,int16_t);
  288. blockSize = arraySizepSrc ;
  289. pDst=PyMem_Malloc(sizeof(q15_t)*blockSize);
  290. arm_copy_q15(pSrc_converted,pDst,blockSize);
  291. INT16ARRAY1(pDstOBJ,blockSize,pDst);
  292. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  293. FREEARGUMENT(pSrc_converted);
  294. Py_DECREF(pDstOBJ);
  295. return(pythonResult);
  296. }
  297. return(NULL);
  298. }
  299. static PyObject *
  300. cmsis_arm_copy_q31(PyObject *obj, PyObject *args)
  301. {
  302. PyObject *pSrc=NULL; // input
  303. q31_t *pSrc_converted=NULL; // input
  304. q31_t *pDst=NULL; // output
  305. uint32_t blockSize; // input
  306. if (PyArg_ParseTuple(args,"O",&pSrc))
  307. {
  308. GETARGUMENT(pSrc,NPY_INT32,int32_t,int32_t);
  309. blockSize = arraySizepSrc ;
  310. pDst=PyMem_Malloc(sizeof(q31_t)*blockSize);
  311. arm_copy_q31(pSrc_converted,pDst,blockSize);
  312. INT32ARRAY1(pDstOBJ,blockSize,pDst);
  313. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  314. FREEARGUMENT(pSrc_converted);
  315. Py_DECREF(pDstOBJ);
  316. return(pythonResult);
  317. }
  318. return(NULL);
  319. }
  320. static PyObject *
  321. cmsis_arm_q7_to_q31(PyObject *obj, PyObject *args)
  322. {
  323. PyObject *pSrc=NULL; // input
  324. q7_t *pSrc_converted=NULL; // input
  325. q31_t *pDst=NULL; // output
  326. uint32_t blockSize; // input
  327. if (PyArg_ParseTuple(args,"O",&pSrc))
  328. {
  329. GETARGUMENT(pSrc,NPY_BYTE,int8_t,q7_t);
  330. blockSize = arraySizepSrc ;
  331. pDst=PyMem_Malloc(sizeof(q31_t)*blockSize);
  332. arm_q7_to_q31(pSrc_converted,pDst,blockSize);
  333. INT32ARRAY1(pDstOBJ,blockSize,pDst);
  334. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  335. FREEARGUMENT(pSrc_converted);
  336. Py_DECREF(pDstOBJ);
  337. return(pythonResult);
  338. }
  339. return(NULL);
  340. }
  341. static PyObject *
  342. cmsis_arm_q7_to_q15(PyObject *obj, PyObject *args)
  343. {
  344. PyObject *pSrc=NULL; // input
  345. q7_t *pSrc_converted=NULL; // input
  346. q15_t *pDst=NULL; // output
  347. uint32_t blockSize; // input
  348. if (PyArg_ParseTuple(args,"O",&pSrc))
  349. {
  350. GETARGUMENT(pSrc,NPY_BYTE,int8_t,q7_t);
  351. blockSize = arraySizepSrc ;
  352. pDst=PyMem_Malloc(sizeof(q15_t)*blockSize);
  353. arm_q7_to_q15(pSrc_converted,pDst,blockSize);
  354. INT16ARRAY1(pDstOBJ,blockSize,pDst);
  355. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  356. FREEARGUMENT(pSrc_converted);
  357. Py_DECREF(pDstOBJ);
  358. return(pythonResult);
  359. }
  360. return(NULL);
  361. }
  362. static PyObject *
  363. cmsis_arm_q7_to_float(PyObject *obj, PyObject *args)
  364. {
  365. PyObject *pSrc=NULL; // input
  366. q7_t *pSrc_converted=NULL; // input
  367. float32_t *pDst=NULL; // output
  368. uint32_t blockSize; // input
  369. if (PyArg_ParseTuple(args,"O",&pSrc))
  370. {
  371. GETARGUMENT(pSrc,NPY_BYTE,int8_t,q7_t);
  372. blockSize = arraySizepSrc ;
  373. pDst=PyMem_Malloc(sizeof(float32_t)*blockSize);
  374. arm_q7_to_float(pSrc_converted,pDst,blockSize);
  375. FLOATARRAY1(pDstOBJ,blockSize,pDst);
  376. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  377. FREEARGUMENT(pSrc_converted);
  378. Py_DECREF(pDstOBJ);
  379. return(pythonResult);
  380. }
  381. return(NULL);
  382. }
  383. static PyObject *
  384. cmsis_arm_q31_to_float(PyObject *obj, PyObject *args)
  385. {
  386. PyObject *pSrc=NULL; // input
  387. q31_t *pSrc_converted=NULL; // input
  388. float32_t *pDst=NULL; // output
  389. uint32_t blockSize; // input
  390. if (PyArg_ParseTuple(args,"O",&pSrc))
  391. {
  392. GETARGUMENT(pSrc,NPY_INT32,int32_t,int32_t);
  393. blockSize = arraySizepSrc ;
  394. pDst=PyMem_Malloc(sizeof(float32_t)*blockSize);
  395. arm_q31_to_float(pSrc_converted,pDst,blockSize);
  396. FLOATARRAY1(pDstOBJ,blockSize,pDst);
  397. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  398. FREEARGUMENT(pSrc_converted);
  399. Py_DECREF(pDstOBJ);
  400. return(pythonResult);
  401. }
  402. return(NULL);
  403. }
  404. static PyObject *
  405. cmsis_arm_float_to_q31(PyObject *obj, PyObject *args)
  406. {
  407. PyObject *pSrc=NULL; // input
  408. float32_t *pSrc_converted=NULL; // input
  409. q31_t *pDst=NULL; // output
  410. uint32_t blockSize; // input
  411. if (PyArg_ParseTuple(args,"O",&pSrc))
  412. {
  413. GETARGUMENT(pSrc,NPY_DOUBLE,double,float32_t);
  414. blockSize = arraySizepSrc ;
  415. pDst=PyMem_Malloc(sizeof(q31_t)*blockSize);
  416. arm_float_to_q31(pSrc_converted,pDst,blockSize);
  417. INT32ARRAY1(pDstOBJ,blockSize,pDst);
  418. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  419. FREEARGUMENT(pSrc_converted);
  420. Py_DECREF(pDstOBJ);
  421. return(pythonResult);
  422. }
  423. return(NULL);
  424. }
  425. static PyObject *
  426. cmsis_arm_float_to_q15(PyObject *obj, PyObject *args)
  427. {
  428. PyObject *pSrc=NULL; // input
  429. float32_t *pSrc_converted=NULL; // input
  430. q15_t *pDst=NULL; // output
  431. uint32_t blockSize; // input
  432. if (PyArg_ParseTuple(args,"O",&pSrc))
  433. {
  434. GETARGUMENT(pSrc,NPY_DOUBLE,double,float32_t);
  435. blockSize = arraySizepSrc ;
  436. pDst=PyMem_Malloc(sizeof(q15_t)*blockSize);
  437. arm_float_to_q15(pSrc_converted,pDst,blockSize);
  438. INT16ARRAY1(pDstOBJ,blockSize,pDst);
  439. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  440. FREEARGUMENT(pSrc_converted);
  441. Py_DECREF(pDstOBJ);
  442. return(pythonResult);
  443. }
  444. return(NULL);
  445. }
  446. static PyObject *
  447. cmsis_arm_float_to_q7(PyObject *obj, PyObject *args)
  448. {
  449. PyObject *pSrc=NULL; // input
  450. float32_t *pSrc_converted=NULL; // input
  451. q7_t *pDst=NULL; // output
  452. uint32_t blockSize; // input
  453. if (PyArg_ParseTuple(args,"O",&pSrc))
  454. {
  455. GETARGUMENT(pSrc,NPY_DOUBLE,double,float32_t);
  456. blockSize = arraySizepSrc ;
  457. pDst=PyMem_Malloc(sizeof(q7_t)*blockSize);
  458. arm_float_to_q7(pSrc_converted,pDst,blockSize);
  459. INT8ARRAY1(pDstOBJ,blockSize,pDst);
  460. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  461. FREEARGUMENT(pSrc_converted);
  462. Py_DECREF(pDstOBJ);
  463. return(pythonResult);
  464. }
  465. return(NULL);
  466. }
  467. static PyObject *
  468. cmsis_arm_q31_to_q15(PyObject *obj, PyObject *args)
  469. {
  470. PyObject *pSrc=NULL; // input
  471. q31_t *pSrc_converted=NULL; // input
  472. q15_t *pDst=NULL; // output
  473. uint32_t blockSize; // input
  474. if (PyArg_ParseTuple(args,"O",&pSrc))
  475. {
  476. GETARGUMENT(pSrc,NPY_INT32,int32_t,int32_t);
  477. blockSize = arraySizepSrc ;
  478. pDst=PyMem_Malloc(sizeof(q15_t)*blockSize);
  479. arm_q31_to_q15(pSrc_converted,pDst,blockSize);
  480. INT16ARRAY1(pDstOBJ,blockSize,pDst);
  481. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  482. FREEARGUMENT(pSrc_converted);
  483. Py_DECREF(pDstOBJ);
  484. return(pythonResult);
  485. }
  486. return(NULL);
  487. }
  488. static PyObject *
  489. cmsis_arm_q31_to_q7(PyObject *obj, PyObject *args)
  490. {
  491. PyObject *pSrc=NULL; // input
  492. q31_t *pSrc_converted=NULL; // input
  493. q7_t *pDst=NULL; // output
  494. uint32_t blockSize; // input
  495. if (PyArg_ParseTuple(args,"O",&pSrc))
  496. {
  497. GETARGUMENT(pSrc,NPY_INT32,int32_t,int32_t);
  498. blockSize = arraySizepSrc ;
  499. pDst=PyMem_Malloc(sizeof(q7_t)*blockSize);
  500. arm_q31_to_q7(pSrc_converted,pDst,blockSize);
  501. INT8ARRAY1(pDstOBJ,blockSize,pDst);
  502. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  503. FREEARGUMENT(pSrc_converted);
  504. Py_DECREF(pDstOBJ);
  505. return(pythonResult);
  506. }
  507. return(NULL);
  508. }
  509. static PyObject *
  510. cmsis_arm_q15_to_float(PyObject *obj, PyObject *args)
  511. {
  512. PyObject *pSrc=NULL; // input
  513. q15_t *pSrc_converted=NULL; // input
  514. float32_t *pDst=NULL; // output
  515. uint32_t blockSize; // input
  516. if (PyArg_ParseTuple(args,"O",&pSrc))
  517. {
  518. GETARGUMENT(pSrc,NPY_INT16,int16_t,int16_t);
  519. blockSize = arraySizepSrc ;
  520. pDst=PyMem_Malloc(sizeof(float32_t)*blockSize);
  521. arm_q15_to_float(pSrc_converted,pDst,blockSize);
  522. FLOATARRAY1(pDstOBJ,blockSize,pDst);
  523. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  524. FREEARGUMENT(pSrc_converted);
  525. Py_DECREF(pDstOBJ);
  526. return(pythonResult);
  527. }
  528. return(NULL);
  529. }
  530. static PyObject *
  531. cmsis_arm_q15_to_q31(PyObject *obj, PyObject *args)
  532. {
  533. PyObject *pSrc=NULL; // input
  534. q15_t *pSrc_converted=NULL; // input
  535. q31_t *pDst=NULL; // output
  536. uint32_t blockSize; // input
  537. if (PyArg_ParseTuple(args,"O",&pSrc))
  538. {
  539. GETARGUMENT(pSrc,NPY_INT16,int16_t,int16_t);
  540. blockSize = arraySizepSrc ;
  541. pDst=PyMem_Malloc(sizeof(q31_t)*blockSize);
  542. arm_q15_to_q31(pSrc_converted,pDst,blockSize);
  543. INT32ARRAY1(pDstOBJ,blockSize,pDst);
  544. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  545. FREEARGUMENT(pSrc_converted);
  546. Py_DECREF(pDstOBJ);
  547. return(pythonResult);
  548. }
  549. return(NULL);
  550. }
  551. static PyObject *
  552. cmsis_arm_q15_to_q7(PyObject *obj, PyObject *args)
  553. {
  554. PyObject *pSrc=NULL; // input
  555. q15_t *pSrc_converted=NULL; // input
  556. q7_t *pDst=NULL; // output
  557. uint32_t blockSize; // input
  558. if (PyArg_ParseTuple(args,"O",&pSrc))
  559. {
  560. GETARGUMENT(pSrc,NPY_INT16,int16_t,int16_t);
  561. blockSize = arraySizepSrc ;
  562. pDst=PyMem_Malloc(sizeof(q7_t)*blockSize);
  563. arm_q15_to_q7(pSrc_converted,pDst,blockSize);
  564. INT8ARRAY1(pDstOBJ,blockSize,pDst);
  565. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  566. FREEARGUMENT(pSrc_converted);
  567. Py_DECREF(pDstOBJ);
  568. return(pythonResult);
  569. }
  570. return(NULL);
  571. }
  572. static PyObject *
  573. cmsis_arm_barycenter_f32(PyObject *obj, PyObject *args)
  574. {
  575. PyObject *pSrcA=NULL; // input
  576. float32_t *pSrcA_converted=NULL; // input
  577. PyObject *pSrcB=NULL; // input
  578. float32_t *pSrcB_converted=NULL; // input
  579. float32_t *pDst=NULL; // output
  580. uint32_t nbVectors,vecDim;
  581. if (PyArg_ParseTuple(args,"OOII",&pSrcA,&pSrcB,&nbVectors,&vecDim))
  582. {
  583. GETARGUMENT(pSrcA,NPY_DOUBLE,double,float32_t);
  584. GETARGUMENT(pSrcB,NPY_DOUBLE,double,float32_t);
  585. pDst=PyMem_Malloc(sizeof(float32_t)*vecDim);
  586. arm_barycenter_f32(pSrcA_converted,pSrcB_converted,pDst,nbVectors,vecDim);
  587. FLOATARRAY1(pDstOBJ,vecDim,pDst);
  588. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  589. FREEARGUMENT(pSrcA_converted);
  590. FREEARGUMENT(pSrcB_converted);
  591. Py_DECREF(pDstOBJ);
  592. return(pythonResult);
  593. }
  594. return(NULL);
  595. }
  596. static PyObject *
  597. cmsis_arm_weighted_sum_f32(PyObject *obj, PyObject *args)
  598. {
  599. PyObject *pSrcA=NULL; // input
  600. float32_t *pSrcA_converted=NULL; // input
  601. PyObject *pSrcB=NULL; // input
  602. float32_t *pSrcB_converted=NULL; // input
  603. float32_t dst; // output
  604. uint32_t blockSize;
  605. if (PyArg_ParseTuple(args,"OO",&pSrcA,&pSrcB))
  606. {
  607. GETARGUMENT(pSrcA,NPY_DOUBLE,double,float32_t);
  608. GETARGUMENT(pSrcB,NPY_DOUBLE,double,float32_t);
  609. blockSize = arraySizepSrcA ;
  610. dst=arm_weighted_sum_f32(pSrcA_converted,pSrcB_converted,blockSize);
  611. PyObject* pDstOBJ=Py_BuildValue("f",dst);
  612. PyObject *pythonResult = Py_BuildValue("O",pDstOBJ);
  613. FREEARGUMENT(pSrcA_converted);
  614. FREEARGUMENT(pSrcB_converted);
  615. Py_DECREF(pDstOBJ);
  616. return(pythonResult);
  617. }
  618. return(NULL);
  619. }
  620. static PyObject *
  621. cmsis_arm_div_int64_to_int32(PyObject *obj, PyObject *args)
  622. {
  623. PyObject *pSrc=NULL; // input
  624. q63_t num;
  625. q31_t den;
  626. q31_t result;
  627. if (PyArg_ParseTuple(args,"Ll",&num,&den))
  628. {
  629. result=arm_div_int64_to_int32(num,den);
  630. PyObject* resultOBJ=Py_BuildValue("l",result);
  631. PyObject *pythonResult = Py_BuildValue("O",resultOBJ);
  632. Py_DECREF(resultOBJ);
  633. return(pythonResult);
  634. }
  635. return(NULL);
  636. }
  637. static PyMethodDef CMSISDSPMethods[] = {
  638. {"arm_div_int64_to_int32", cmsis_arm_div_int64_to_int32, METH_VARARGS,""},
  639. {"arm_copy_f64", cmsis_arm_copy_f64, METH_VARARGS,""},
  640. {"arm_copy_f32", cmsis_arm_copy_f32, METH_VARARGS,""},
  641. {"arm_copy_q7", cmsis_arm_copy_q7, METH_VARARGS,""},
  642. {"arm_copy_q15", cmsis_arm_copy_q15, METH_VARARGS,""},
  643. {"arm_copy_q31", cmsis_arm_copy_q31, METH_VARARGS,""},
  644. {"arm_q7_to_q31", cmsis_arm_q7_to_q31, METH_VARARGS,""},
  645. {"arm_q7_to_q15", cmsis_arm_q7_to_q15, METH_VARARGS,""},
  646. {"arm_q7_to_float", cmsis_arm_q7_to_float, METH_VARARGS,""},
  647. {"arm_q31_to_float", cmsis_arm_q31_to_float, METH_VARARGS,""},
  648. {"arm_float_to_q31", cmsis_arm_float_to_q31, METH_VARARGS,""},
  649. {"arm_float_to_q15", cmsis_arm_float_to_q15, METH_VARARGS,""},
  650. {"arm_float_to_q7", cmsis_arm_float_to_q7, METH_VARARGS,""},
  651. {"arm_q31_to_q15", cmsis_arm_q31_to_q15, METH_VARARGS,""},
  652. {"arm_q31_to_q7", cmsis_arm_q31_to_q7, METH_VARARGS,""},
  653. {"arm_q15_to_float", cmsis_arm_q15_to_float, METH_VARARGS,""},
  654. {"arm_q15_to_q31", cmsis_arm_q15_to_q31, METH_VARARGS,""},
  655. {"arm_q15_to_q7", cmsis_arm_q15_to_q7, METH_VARARGS,""},
  656. {"arm_fill_f64", cmsis_arm_fill_f64, METH_VARARGS,""},
  657. {"arm_fill_f32", cmsis_arm_fill_f32, METH_VARARGS,""},
  658. {"arm_fill_q31", cmsis_arm_fill_q31, METH_VARARGS,""},
  659. {"arm_fill_q15", cmsis_arm_fill_q15, METH_VARARGS,""},
  660. {"arm_fill_q7", cmsis_arm_fill_q7, METH_VARARGS,""},
  661. {"arm_sort_f32", cmsis_arm_sort_f32, METH_VARARGS,""},
  662. {"arm_sort_init_f32", cmsis_arm_sort_init_f32, METH_VARARGS,""},
  663. {"arm_barycenter_f32", cmsis_arm_barycenter_f32, METH_VARARGS,""},
  664. {"arm_weighted_sum_f32", cmsis_arm_weighted_sum_f32, METH_VARARGS,""},
  665. {"error_out", (PyCFunction)error_out, METH_NOARGS, NULL},
  666. {NULL, NULL, 0, NULL} /* Sentinel */
  667. };
  668. #ifdef IS_PY3K
  669. static int cmsisdsp_traverse(PyObject *m, visitproc visit, void *arg) {
  670. Py_VISIT(GETSTATE(m)->error);
  671. return 0;
  672. }
  673. static int cmsisdsp_clear(PyObject *m) {
  674. Py_CLEAR(GETSTATE(m)->error);
  675. return 0;
  676. }
  677. static struct PyModuleDef moduledef = {
  678. PyModuleDef_HEAD_INIT,
  679. MODNAME,
  680. NULL,
  681. sizeof(struct module_state),
  682. CMSISDSPMethods,
  683. NULL,
  684. cmsisdsp_traverse,
  685. cmsisdsp_clear,
  686. NULL
  687. };
  688. #define INITERROR return NULL
  689. PyMODINIT_FUNC
  690. CAT(PyInit_,MODINITNAME)(void)
  691. #else
  692. #define INITERROR return
  693. void CAT(init,MODINITNAME)(void)
  694. #endif
  695. {
  696. import_array();
  697. #ifdef IS_PY3K
  698. PyObject *module = PyModule_Create(&moduledef);
  699. #else
  700. PyObject *module = Py_InitModule(MODNAME, CMSISDSPMethods);
  701. #endif
  702. if (module == NULL)
  703. INITERROR;
  704. struct module_state *st = GETSTATE(module);
  705. st->error = PyErr_NewException(MODNAME".Error", NULL, NULL);
  706. if (st->error == NULL) {
  707. Py_DECREF(module);
  708. INITERROR;
  709. }
  710. typeRegistration(module);
  711. #ifdef IS_PY3K
  712. return module;
  713. #endif
  714. }