Embedded/pikapython
1
0
Fork 0
mirror of https://gitee.com/Lyon1998/pikapython.git synced 2025-01-29 17:22:56 +08:00
Code Issues Packages Projects Releases Wiki Activity
pikapython/package/modbus_rt/_modbus_rt_data_trans.c

467 lines
14 KiB
C
Raw Blame History

/**
* @file _modbus_rt.c
* @brief modbus_rt的pika层的API实现
* @author SenySunny (senysunny@163.com)
* @date 2023-05-14
*
* @attention
*
* <h2><center>&copy; Copyright (c) 2022 Ma Longwei.
* All rights reserved.</center></h2>
*
*/
#include "PikaStdData_List.h"
#include "_modbus_rt__data_trans.h"
#include "modbus_rt_platform_memory.h"
#include "modbus_data_trans.h"
int _modbus_rt__data_trans__reg2reg(PikaObj *self, int val) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return 0;
#else
return modbus_data_reg2reg((uint16_t)val);
#endif
}
PikaObj* _modbus_rt__data_trans__regs2regs(PikaObj *self, PikaObj* val) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
size_t len_list = pikaList_getSize(val);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_list; i++ ) {
uint16_t temp = (uint16_t)pikaList_getInt(val, i);
pikaList_append(list, arg_newInt(modbus_data_reg2reg(temp)));
}
return list;
#endif
}
Arg* _modbus_rt__data_trans__regs2bytes(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint8_t *_Dst = NULL;
uint16_t *_Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len = len_list << 1;
_Dst = modbus_rt_calloc(1,len);
_Src = modbus_rt_calloc(1,len);
for(size_t i = 0;i < len_list; i++) {
_Src[i] = (uint16_t)pikaList_getInt(val, i);
}
modbus_data_regs2bytes(mode, _Dst, _Src, len_list);
Arg* r = arg_newBytes(_Dst, len);
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return r;
#endif
}
char* _modbus_rt__data_trans__regs2str(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
char *_Dst = NULL;
uint16_t *_Src = NULL;
size_t len_list = pikaList_getSize(val);
_Dst = modbus_rt_calloc(1,(len_list << 1) + 1);
_Src = modbus_rt_calloc(1,len_list << 1);
for(size_t i = 0;i < len_list; i++) {
_Src[i] = (uint16_t)pikaList_getInt(val, i);
}
modbus_data_regs2str(mode, _Dst, _Src, len_list);
char* str = obj_cacheStr(self, _Dst);
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return str;
#endif
}
PikaObj* _modbus_rt__data_trans__regs2signed(PikaObj *self, PikaObj* val, int mode){
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
int16_t *_Dst = NULL;
uint16_t *_Src = NULL;
size_t len_list = pikaList_getSize(val);
_Dst = modbus_rt_calloc(1,len_list << 1);
_Src = modbus_rt_calloc(1,len_list << 1);
for(size_t i = 0;i < len_list; i++) {
_Src[i] = (uint16_t)pikaList_getInt(val, i);
}
modbus_data_regs2signed(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_list; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__regs2int(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
int32_t *_Dst = NULL;
uint16_t *_Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list >> 1;
if(len_list & 0x01) {
len_ret += 1;
}
_Dst = modbus_rt_calloc(1,len_ret << 2);
_Src = modbus_rt_calloc(1,len_list << 1);
for(size_t i = 0;i < len_list; i++) {
_Src[i] = (uint16_t)pikaList_getInt(val, i);
}
modbus_data_regs2int(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__regs2uint(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint32_t *_Dst = NULL;
uint16_t *_Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list >> 1;
if(len_list & 0x01) {
len_ret += 1;
}
_Dst = modbus_rt_calloc(1,len_ret << 2);
_Src = modbus_rt_calloc(1,len_list << 1);
for(size_t i = 0;i < len_list; i++) {
_Src[i] = (uint16_t)pikaList_getInt(val, i);
}
modbus_data_regs2uint(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__regs2long(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
int64_t *_Dst = NULL;
uint16_t *_Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list >> 2;
if(len_list & 0x03) {
len_ret += 1;
}
_Dst = modbus_rt_calloc(1,len_ret << 3);
_Src = modbus_rt_calloc(1,len_list << 1);
for(size_t i = 0;i < len_list; i++) {
_Src[i] = (uint16_t)pikaList_getInt(val, i);
}
modbus_data_regs2long(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__regs2float(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
float *_Dst = NULL;
uint16_t *_Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list >> 1;
if(len_list & 0x01) {
len_ret += 1;
}
_Dst = modbus_rt_calloc(1,len_ret << 2);
_Src = modbus_rt_calloc(1,len_list << 1);
for(size_t i = 0;i < len_list; i++) {
_Src[i] = (uint16_t)pikaList_getInt(val, i);
}
modbus_data_regs2float(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newFloat(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__regs2double(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
double *_Dst = NULL;
uint16_t *_Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list >> 2;
if(len_list & 0x03) {
len_ret += 1;
}
_Dst = modbus_rt_calloc(1,len_ret << 3);
_Src = modbus_rt_calloc(1,len_list << 1);
for(size_t i = 0;i < len_list; i++) {
_Src[i] = (uint16_t)pikaList_getInt(val, i);
}
modbus_data_regs2double(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newFloat(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__bytes2regs(PikaObj *self, Arg* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
ArgType t = arg_getType(val);
if (ARG_TYPE_BYTES != t) {
return NULL;
}
uint16_t *_Dst = NULL;
uint8_t* _Src = arg_getBytes(val);
size_t _Src_len = arg_getBytesSize(val);
size_t len_ret = _Src_len >> 1;
if(_Src_len & 0x01) {
len_ret += 1;
}
_Dst = modbus_rt_calloc(1,len_ret << 1);
modbus_data_bytes2regs(mode, _Dst, _Src, _Src_len);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__str2regs(PikaObj *self, char* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint16_t *_Dst = NULL;
char * _Src = val;
size_t _Src_len = strlen(val) + 1;
size_t len_ret = _Src_len >> 1;
if(_Src_len & 0x01) {
len_ret += 1;
}
_Dst = modbus_rt_calloc(1,len_ret << 1);
modbus_data_str2regs(mode, _Dst, _Src, _Src_len);
PikaList* list = New_PikaList();
for(size_t i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__signed2regs(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint16_t *_Dst = NULL;
int16_t * _Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list;
_Dst = modbus_rt_calloc(1,len_ret << 1);
_Src = modbus_rt_calloc(1,len_list << 1);
for(int i = 0; i < len_list; i++ ) {
_Src[i] = (int16_t)pikaList_getInt(val, i);
}
modbus_data_signed2regs(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(int i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__int2regs(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint16_t *_Dst = NULL;
int32_t * _Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list << 1;
_Dst = modbus_rt_calloc(1,len_ret << 1);
_Src = modbus_rt_calloc(1,len_list << 2);
for(int i = 0; i < len_list; i++ ) {
_Src[i] = (int32_t)pikaList_getInt(val, i);
}
modbus_data_int2regs(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(int i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__uint2regs(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint16_t *_Dst = NULL;
uint32_t * _Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list << 1;
_Dst = modbus_rt_calloc(1,len_ret << 1);
_Src = modbus_rt_calloc(1,len_list << 2);
for(int i = 0; i < len_list; i++ ) {
_Src[i] = (uint32_t)pikaList_getInt(val, i);
}
modbus_data_uint2regs(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(int i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__long2regs(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint16_t *_Dst = NULL;
int64_t * _Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list << 2;
_Dst = modbus_rt_calloc(1,len_ret << 1);
_Src = modbus_rt_calloc(1,len_list << 3);
for(int i = 0; i < len_list; i++ ) {
_Src[i] = (int64_t)pikaList_getInt(val, i);
}
modbus_data_long2regs(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(int i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__float2regs(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint16_t *_Dst = NULL;
float * _Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list << 1;
_Dst = modbus_rt_calloc(1,len_ret << 1);
_Src = modbus_rt_calloc(1,len_list << 2);
for(int i = 0; i < len_list; i++ ) {
_Src[i] = (float)pikaList_getFloat(val, i);
}
modbus_data_float2regs(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(int i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
PikaObj* _modbus_rt__data_trans__double2regs(PikaObj *self, PikaObj* val, int mode) {
#if (!MODBUS_DATA_TRANS_ENABLE)
pika_platform_printf("MODBUS_DATA_TRANS_ENABLE is not enabled.\n");
return NULL;
#else
(void)(self);
uint16_t *_Dst = NULL;
double * _Src = NULL;
size_t len_list = pikaList_getSize(val);
size_t len_ret = len_list << 2;
_Dst = modbus_rt_calloc(1,len_ret << 1);
_Src = modbus_rt_calloc(1,len_list << 3);
for(int i = 0; i < len_list; i++ ) {
_Src[i] = (double)pikaList_getFloat(val, i);
}
modbus_data_double2regs(mode, _Dst, _Src, len_list);
PikaList* list = New_PikaList();
for(int i = 0; i < len_ret; i++ ) {
pikaList_append(list, arg_newInt(_Dst[i]));
}
modbus_rt_free(_Dst);
modbus_rt_free(_Src);
return list;
#endif
}
Reference in New Issue View Git Blame Copy Permalink