|
@@ -1,325 +0,0 @@
|
|
|
-/******************************************************************************
|
|
|
|
|
-版权所有:
|
|
|
|
|
-文件名称: sxyb.c
|
|
|
|
|
-文件版本: 01.01
|
|
|
|
|
-创建作者:
|
|
|
|
|
-创建日期: 2016-09-28
|
|
|
|
|
-功能说明: 数显仪表实现文件
|
|
|
|
|
-其它说明:
|
|
|
|
|
-修改记录:
|
|
|
|
|
-*/
|
|
|
|
|
-
|
|
|
|
|
-#include "head.h"
|
|
|
|
|
-#ifdef LINUX_KERNEL_APP
|
|
|
|
|
-#include "sxyb.h"
|
|
|
|
|
-#include <linux/kernel.h>
|
|
|
|
|
-#include <linux/init.h>
|
|
|
|
|
-#include <linux/module.h>
|
|
|
|
|
-#include <linux/moduleparam.h>
|
|
|
|
|
-#include <linux/fs.h>
|
|
|
|
|
-#include <linux/sched.h>
|
|
|
|
|
-#include <linux/interrupt.h>
|
|
|
|
|
-#include <linux/kthread.h>
|
|
|
|
|
-#include <linux/delay.h>
|
|
|
|
|
-#include <linux/wait.h>
|
|
|
|
|
-#include <asm/uaccess.h>
|
|
|
|
|
-#include <asm/io.h>
|
|
|
|
|
-#include <asm/ioctls.h>
|
|
|
|
|
-#include <linux/syscalls.h>
|
|
|
|
|
-#include <termios.h>
|
|
|
|
|
-#else
|
|
|
|
|
-#include "head.h"
|
|
|
|
|
-#include "sxyb.h"
|
|
|
|
|
-#include <linux/fs.h>
|
|
|
|
|
-#include <linux/sched.h>
|
|
|
|
|
-#include <linux/wait.h>
|
|
|
|
|
-#include <asm/ioctls.h>
|
|
|
|
|
-#include <termios.h>
|
|
|
|
|
-#endif
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-#define SXYB_NO_DATA 0x1 //缓冲区没有数据
|
|
|
|
|
-#define SXYB_HAS_DATA 0x2 //缓冲区有数据
|
|
|
|
|
-
|
|
|
|
|
-#define SXYB_ADDR 1 //表地址
|
|
|
|
|
-#define SXYB_WRITE_CMD 0xFE //命令
|
|
|
|
|
-#define SXYB_BUF_SIZE 256
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-static u8 sxyb_buf[SXYB_BUF_SIZE];
|
|
|
|
|
-
|
|
|
|
|
-static int sxyb_buf_cnt = 0;
|
|
|
|
|
-static int sxyb_buf_index = 0;
|
|
|
|
|
-
|
|
|
|
|
-static unsigned long g_us0=0;
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-static int g_sxyb_status=SXYB_NO_DATA;
|
|
|
|
|
-
|
|
|
|
|
-#if 0
|
|
|
|
|
-BYTE MoDusCRCtableHi[] = // Modbus 高位校验码
|
|
|
|
|
-{
|
|
|
|
|
- 0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,
|
|
|
|
|
- 0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,
|
|
|
|
|
- 0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,
|
|
|
|
|
- 0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,
|
|
|
|
|
- 0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,
|
|
|
|
|
- 0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,
|
|
|
|
|
- 0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,
|
|
|
|
|
- 0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,
|
|
|
|
|
- 0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,
|
|
|
|
|
- 0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,
|
|
|
|
|
- 0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,
|
|
|
|
|
- 0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,
|
|
|
|
|
- 0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,
|
|
|
|
|
- 0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,
|
|
|
|
|
- 0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40,0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,
|
|
|
|
|
- 0x00,0xC1,0x81,0x40,0x01,0xC0,0x80,0x41,0x01,0xC0,0x80,0x41,0x00,0xC1,0x81,0x40
|
|
|
|
|
-} ;
|
|
|
|
|
-
|
|
|
|
|
-//-------------------------------------------------------------
|
|
|
|
|
-
|
|
|
|
|
-//@@***********************************************************
|
|
|
|
|
-
|
|
|
|
|
-// MoDus CRC 低位字节值表
|
|
|
|
|
-
|
|
|
|
|
-//@@***********************************************************
|
|
|
|
|
-
|
|
|
|
|
-//-------------------------------------------------------------
|
|
|
|
|
-
|
|
|
|
|
-BYTE MoDusCRCtableLo[] =
|
|
|
|
|
-{
|
|
|
|
|
- 0x00,0xC0,0xC1,0x01,0xC3,0x03,0x02,0xC2,0xC6,0x06,0x07,0xC7,0x05,0xC5,0xC4,0x04,
|
|
|
|
|
- 0xCC,0x0C,0x0D,0xCD,0x0F,0xCF,0xCE,0x0E,0x0A,0xCA,0xCB,0x0B,0xC9,0x09,0x08,0xC8,
|
|
|
|
|
- 0xD8,0x18,0x19,0xD9,0x1B,0xDB,0xDA,0x1A,0x1E,0xDE,0xDF,0x1F,0xDD,0x1D,0x1C,0xDC,
|
|
|
|
|
- 0x14,0xD4,0xD5,0x15,0xD7,0x17,0x16,0xD6,0xD2,0x12,0x13,0xD3,0x11,0xD1,0xD0,0x10,
|
|
|
|
|
- 0xF0,0x30,0x31,0xF1,0x33,0xF3,0xF2,0x32,0x36,0xF6,0xF7,0x37,0xF5,0x35,0x34,0xF4,
|
|
|
|
|
- 0x3C,0xFC,0xFD,0x3D,0xFF,0x3F,0x3E,0xFE,0xFA,0x3A,0x3B,0xFB,0x39,0xF9,0xF8,0x38,
|
|
|
|
|
- 0x28,0xE8,0xE9,0x29,0xEB,0x2B,0x2A,0xEA,0xEE,0x2E,0x2F,0xEF,0x2D,0xED,0xEC,0x2C,
|
|
|
|
|
- 0xE4,0x24,0x25,0xE5,0x27,0xE7,0xE6,0x26,0x22,0xE2,0xE3,0x23,0xE1,0x21,0x20,0xE0,
|
|
|
|
|
- 0xA0,0x60,0x61,0xA1,0x63,0xA3,0xA2,0x62,0x66,0xA6,0xA7,0x67,0xA5,0x65,0x64,0xA4,
|
|
|
|
|
- 0x6C,0xAC,0xAD,0x6D,0xAF,0x6F,0x6E,0xAE,0xAA,0x6A,0x6B,0xAB,0x69,0xA9,0xA8,0x68,
|
|
|
|
|
- 0x78,0xB8,0xB9,0x79,0xBB,0x7B,0x7A,0xBA,0xBE,0x7E,0x7F,0xBF,0x7D,0xBD,0xBC,0x7C,
|
|
|
|
|
- 0xB4,0x74,0x75,0xB5,0x77,0xB7,0xB6,0x76,0x72,0xB2,0xB3,0x73,0xB1,0x71,0x70,0xB0,
|
|
|
|
|
- 0x50,0x90,0x91,0x51,0x93,0x53,0x52,0x92,0x96,0x56,0x57,0x97,0x55,0x95,0x94,0x54,
|
|
|
|
|
- 0x9C,0x5C,0x5D,0x9D,0x5F,0x9F,0x9E,0x5E,0x5A,0x9A,0x9B,0x5B,0x99,0x59,0x58,0x98,
|
|
|
|
|
- 0x88,0x48,0x49,0x89,0x4B,0x8B,0x8A,0x4A,0x4E,0x8E,0x8F,0x4F,0x8D,0x4D,0x4C,0x8C,
|
|
|
|
|
- 0x44,0x84,0x85,0x45,0x87,0x47,0x46,0x86,0x82,0x42,0x43,0x83,0x41,0x81,0x80,0x40
|
|
|
|
|
-} ;
|
|
|
|
|
-
|
|
|
|
|
-/**************************************************************************
|
|
|
|
|
-函数名称:Modbus_CRC16
|
|
|
|
|
-函数版本:1.00
|
|
|
|
|
-作者:
|
|
|
|
|
-创建日期:2008.11.15
|
|
|
|
|
-函数功能说明:Modbus规约的CRC校验
|
|
|
|
|
-输入参数:
|
|
|
|
|
-输出参数:
|
|
|
|
|
-返回值:
|
|
|
|
|
-
|
|
|
|
|
-更新信息:
|
|
|
|
|
-更新日志1:
|
|
|
|
|
-日期:
|
|
|
|
|
-修改者:
|
|
|
|
|
-修改内容:
|
|
|
|
|
-修改原因:
|
|
|
|
|
-***************************************************************************/
|
|
|
|
|
-
|
|
|
|
|
-WORD Modbus_CRC16(BYTE *inbytes, WORD CRCnumber) // 返回,低字节在高位
|
|
|
|
|
-
|
|
|
|
|
-{
|
|
|
|
|
-
|
|
|
|
|
- BYTE crcbyteHi = 0xFF ;
|
|
|
|
|
-
|
|
|
|
|
- BYTE crcbyteLo = 0xFF ;
|
|
|
|
|
-
|
|
|
|
|
- BYTE uIndex ;
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
- while (CRCnumber--)
|
|
|
|
|
-
|
|
|
|
|
- {
|
|
|
|
|
-
|
|
|
|
|
- uIndex = crcbyteHi ^ *inbytes++ ;
|
|
|
|
|
-
|
|
|
|
|
- crcbyteHi = crcbyteLo ^ MoDusCRCtableHi[uIndex] ;
|
|
|
|
|
-
|
|
|
|
|
- crcbyteLo = MoDusCRCtableLo[uIndex] ;
|
|
|
|
|
-
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- return ( (crcbyteHi << 8) | crcbyteLo ) ;
|
|
|
|
|
-
|
|
|
|
|
-}
|
|
|
|
|
-
|
|
|
|
|
-#endif
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-/******************************************************************************
|
|
|
|
|
-函数名称: sxyb_init
|
|
|
|
|
-函数版本: 01.01
|
|
|
|
|
-创建作者: xxxxxx
|
|
|
|
|
-创建日期: 2016-9-28
|
|
|
|
|
-函数说明: 数显仪表初始化。
|
|
|
|
|
-参数说明:
|
|
|
|
|
- lock: 锁.
|
|
|
|
|
-返回值: 无.
|
|
|
|
|
-修改记录:
|
|
|
|
|
-*/
|
|
|
|
|
-void sxyb_init(void)
|
|
|
|
|
-{
|
|
|
|
|
- sxyb_buf_cnt = 0;
|
|
|
|
|
- sxyb_buf_index = 0;
|
|
|
|
|
- g_sxyb_status=SXYB_NO_DATA;
|
|
|
|
|
-
|
|
|
|
|
-}
|
|
|
|
|
-
|
|
|
|
|
-/******************************************************************************
|
|
|
|
|
-函数名称: sxyb_App
|
|
|
|
|
-函数版本: 01.01
|
|
|
|
|
-创建作者: xxxxxx
|
|
|
|
|
-创建日期: 2016-9-28
|
|
|
|
|
-函数说明: 数显仪表报文组包
|
|
|
|
|
-参数说明:
|
|
|
|
|
- 无
|
|
|
|
|
-返回值: 无.
|
|
|
|
|
-修改记录:
|
|
|
|
|
-*/
|
|
|
|
|
-//long GetRmtMeaVal(int owner,int index) //取遥测值
|
|
|
|
|
-void sxyb_App(void)
|
|
|
|
|
-{
|
|
|
|
|
- long val=0;
|
|
|
|
|
- long lzero=0;
|
|
|
|
|
- int i = 0;
|
|
|
|
|
- int idx = 0;
|
|
|
|
|
- int sw = 0;
|
|
|
|
|
- int index_begin;
|
|
|
|
|
- u16 crc=0;
|
|
|
|
|
- s32 tmp;
|
|
|
|
|
-
|
|
|
|
|
- //如果没有到1秒时间,不发送
|
|
|
|
|
- if(ustimer_get_duration(g_us0)<USTIMER_SEC)
|
|
|
|
|
- {
|
|
|
|
|
- return;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- //如果缓存区还有数据,不写缓存区
|
|
|
|
|
- if(g_sxyb_status != SXYB_NO_DATA)
|
|
|
|
|
- {
|
|
|
|
|
- return;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- sxyb_buf[idx++] = SXYB_ADDR;
|
|
|
|
|
- sxyb_buf[idx++] = SXYB_WRITE_CMD;
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
- for(i=PUB_AC_UAB1;i<=PUB_AC_UCA1;i++)
|
|
|
|
|
- {
|
|
|
|
|
-
|
|
|
|
|
- tmp = (int)rt_round((float)g_ui[i].e/Q16_BASE *g_ui[i].e_ps*1000/1000); // 1000倍/1000V
|
|
|
|
|
- val=g_ui[i].e;
|
|
|
|
|
- lzero=g_unit[g_pub_ac_desc[i].unit].zero;
|
|
|
|
|
- if(lzero>0&&_AbsL(val)<lzero && pRunSet->bTT_RET_ZERO)
|
|
|
|
|
- {
|
|
|
|
|
- tmp = 0;
|
|
|
|
|
- }
|
|
|
|
|
- sxyb_buf[idx++]=tmp & 0xFF;
|
|
|
|
|
- sxyb_buf[idx++]=(tmp >> 8) & 0xFF;
|
|
|
|
|
- sxyb_buf[idx++]=(tmp >> 16)& 0xFF;
|
|
|
|
|
- sxyb_buf[idx++]=(tmp >> 24) & 0xFF;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
- for(sw=0;sw<SWITCH_NUM_MAX;sw++)
|
|
|
|
|
- {
|
|
|
|
|
- index_begin = UI_SW_INDEX_BEGIN(sw);
|
|
|
|
|
- for(i=SW_AC_IA;i<=SW_AC_IC;i++)
|
|
|
|
|
- {
|
|
|
|
|
-
|
|
|
|
|
- tmp = (int)rt_round((float)g_ui[index_begin+i].e/Q16_BASE * g_ui[index_begin+i].e_ps*1000);
|
|
|
|
|
- val=g_ui[index_begin+i].e;
|
|
|
|
|
- lzero=g_unit[g_sw_ac_desc[i].unit].zero;
|
|
|
|
|
- if(lzero>0&&_AbsL(val)<lzero && pRunSet->bTT_RET_ZERO)
|
|
|
|
|
- {
|
|
|
|
|
- tmp = 0;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- sxyb_buf[idx++]=tmp & 0xFF;
|
|
|
|
|
- sxyb_buf[idx++]=(tmp >> 8) & 0xFF;
|
|
|
|
|
- sxyb_buf[idx++]=(tmp >> 16)& 0xFF;
|
|
|
|
|
- sxyb_buf[idx++]=(tmp >> 24) & 0xFF;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
- crc = Modbus_CRC16(sxyb_buf, idx);
|
|
|
|
|
-
|
|
|
|
|
- sxyb_buf[idx++]=(u8)(crc >> 8);
|
|
|
|
|
- sxyb_buf[idx++]=(u8)crc;
|
|
|
|
|
- sxyb_buf_cnt =idx;
|
|
|
|
|
- g_us0 = ustimer_get_origin();
|
|
|
|
|
- g_sxyb_status = SXYB_HAS_DATA; //置这个标志,表示缓存区已经有数据
|
|
|
|
|
-
|
|
|
|
|
-}
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-/******************************************************************************
|
|
|
|
|
-函数名称: sxyb_proc
|
|
|
|
|
-函数版本: 01.01
|
|
|
|
|
-创建作者: xxxxxx
|
|
|
|
|
-创建日期: 2016-9-28
|
|
|
|
|
-函数说明: 数显仪表处理
|
|
|
|
|
-参数说明:
|
|
|
|
|
- 无
|
|
|
|
|
-返回值: 无.
|
|
|
|
|
-修改记录:
|
|
|
|
|
-*/
|
|
|
|
|
-void sxyb_proc(int chnl)
|
|
|
|
|
-{
|
|
|
|
|
-#ifdef CPU_COLDFIRE
|
|
|
|
|
- volatile unsigned char status;
|
|
|
|
|
-
|
|
|
|
|
- //主任务在写数据,退出
|
|
|
|
|
- if(g_sxyb_status != SXYB_HAS_DATA)
|
|
|
|
|
- {
|
|
|
|
|
- return;
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
- status=MCF_UART_USR(chnl);
|
|
|
|
|
-
|
|
|
|
|
- //有数据要发送
|
|
|
|
|
- if(sxyb_buf_index < sxyb_buf_cnt )
|
|
|
|
|
- {
|
|
|
|
|
- if (status& MCF_UART_USR_TXRDY) // 可发送数据
|
|
|
|
|
- {
|
|
|
|
|
-
|
|
|
|
|
- MCF_UART_UTB(chnl) = sxyb_buf[sxyb_buf_index++];
|
|
|
|
|
- }
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
- }
|
|
|
|
|
- else if(status & MCF_UART_USR_TXEMP)
|
|
|
|
|
- {
|
|
|
|
|
- sxyb_buf_index = 0; //清零
|
|
|
|
|
- g_sxyb_status = SXYB_NO_DATA; //置这个标志,表示缓冲区的数据已经被读取
|
|
|
|
|
-
|
|
|
|
|
- }
|
|
|
|
|
-#endif
|
|
|
|
|
-}
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|
|
|
-
|
|
|