一个简单的zstack-2.4.0-1.4.0x
/********************************************************************************************** 文件： Coordinator.c
* 说明：基于Sapi架构的应用层文件，参考：SimpleCollector
* 修改：
* 注释：
*********************************************************************************************/
/*********************************************************************************************
* 头文件
*********************************************************************************************/
#include "ZComDef.h"
#include "OSAL.h"
#include "sapi.h"
#include "hal_key.h"
#include "hal_led.h"
#include "DebugTrace.h"
#include "SimpleApp.h"
#include "hal_flash.h"
#include "ZDApp.h"
#if defined( MT_TASK )
#include "osal_nv.h"
#endif
#include "mt_app.h"
#include "mt_uart.h"
#include "mt.h"
#include "rtg.h"
#include "mac_radio_defs.h"
#include "AddrMgr.h"
#include "nwk_util.h"
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
/*********************************************************************************************
* 宏定义
*********************************************************************************************/
#define USE_SYS_FIND_DEVICE 0
#define NODE_NAME"000"
#define NODE_CATEGORY 1
#define OSAL_NV_PAGE_BEG HAL_NV_PAGE_BEG
#define OSAL_NV_PAGE_END (OSAL_NV_PAGE_BEG + HAL_NV_PAGE_CNT - 1)
// Application States
#define APP_INIT 0
#define APP_START 1
// Application osal event identifiers
#define _START_EVT 0x0010
#define __REPORT_EVT 0x0020
// Same definitions as in SimpleSensor.c
#define REPORT_DELAY 30
#define NUM_OUT_CMD_COLLECTOR 2
#define NUM_IN_CMD_COLLECTOR 3
/*********************************************************************************************
* 全局变量
*********************************************************************************************/
#if defined( MT_TASK )
extern uint8 aExtendedAddress;
#endif
static uint16 panid;
static uint8 logicalType;
static uint16 _tm_cnt, _tm_delay;
static char wbuf;
// List of output and input commands for Switch device
const cId_t zb_InCmdList =
{
ID_CMD_READ_RES,
ID_CMD_WRITE_RES,
ID_CMD_REPORT,
};
const cId_t zb_OutCmdList =
{
ID_CMD_READ_REQ,
ID_CMD_WRITE_REQ,
};
// Define SimpleDescriptor for Switch device
const SimpleDescriptionFormat_t zb_SimpleDesc =
{
MY_ENDPOINT_ID, //Endpoint
MY_PROFILE_ID, //Profile ID
DEV_ID_COLLECTOR, //Device ID
DEVICE_VERSION_COLLECTOR, //Device Version
0, //Reserved
NUM_IN_CMD_COLLECTOR, //Number of Input Commands
(cId_t *) zb_InCmdList, //Input Command List
NUM_OUT_CMD_COLLECTOR, //Number of Output Commands
(cId_t *) zb_OutCmdList //Output Command List
};
/*********************************************************************************************
* 函数原型说明
*********************************************************************************************/
static void my_report_proc(void);
static void process_set_command_call(int (*fun)(char *ptag, char *pval, char *pout));
static void process_package(char *pkg, int len);
static int process_command_callback(char *ptag, char *pval, char *pout);
void zb_HanderMsg(osal_event_hdr_t *pMsg);
static void processCommand(uint16 cmd, byte *dat, uint8 len);
void my_FindDevice(uint8 searchType, uint8 *searchKey);
int my_FindDeviceProc( uint16 source, uint16 command, uint16 len, uint8 *pData);
static char* read_nb(char *buf, int len);
static int (*process_command_call)(char *ptag, char *pval, char *pout);
/*********************************************************************************************
* 名称：zb_HandleOsalEvent()
* 功能：sapi事件处理函数，当一个任务事件发生了之后，调用这个函数
* 参数：event - 产生的任务事件
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_HandleOsalEvent( uint16 event )
{
if (event & ZB_ENTRY_EVENT) {
uint8 startOptions;
zb_ReadConfiguration( ZCD_NV_LOGICAL_TYPE, sizeof(uint8), &logicalType );
if ( logicalType != ZG_DEVICETYPE_COORDINATOR )
{
logicalType = ZG_DEVICETYPE_COORDINATOR;
zb_WriteConfiguration(ZCD_NV_LOGICAL_TYPE, sizeof(uint8), &logicalType);
zb_SystemReset();
}
zb_ReadConfiguration( ZCD_NV_STARTUP_OPTION, sizeof(uint8), &startOptions );
if ((startOptions & ZCD_STARTOPT_AUTO_START) == 0) {
zb_StartRequest();
}
osal_nv_read( ZCD_NV_PANID, 0, sizeof( panid ), &panid );
HalLedSet( HAL_LED_2, HAL_LED_MODE_FLASH );
process_set_command_call(process_command_callback);
}
if (event & __REPORT_EVT) { // 触发上报网络参数事件
if (_tm_cnt > 0) {
my_report_proc();
osal_start_timerEx( sapi_TaskID, __REPORT_EVT, _tm_delay * 1000);
_tm_cnt --;
}
}
}
/*********************************************************************************************
* 名称：zb_HanderMsg()
* 功能：MT串口处理函数，处理收到上位机到协调器的串口数据
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_HanderMsg(osal_event_hdr_t *msg)
{
mtSysAppMsg_t *pMsg = (mtSysAppMsg_t*)msg;
uint16 dAddr;
uint16 cmd;
uint16 addr = NLME_GetShortAddr();
HalLedSet( HAL_LED_1, HAL_LED_MODE_OFF );
HalLedSet( HAL_LED_1, HAL_LED_MODE_BLINK );
if (pMsg->hdr.event == MT_SYS_APP_MSG) {
//if (pMsg->appDataLen < 4) return;
dAddr = pMsg->appData<<8 | pMsg->appData;
cmd = pMsg->appData<<8 | pMsg->appData;
if (dAddr != 0) {
zb_SendDataRequest(dAddr, cmd, pMsg->appDataLen-4, pMsg->appData+4, 0, AF_ACK_REQUEST, AF_DEFAULT_RADIUS );
}
if (dAddr == 0 || dAddr == 0xffff) {
processCommand(cmd, pMsg->appData+4, pMsg->appDataLen-4);
}
}
}
/*********************************************************************************************
* 名称：zb_HandleKeys()
* 功能：处理节点产生的按键事件
* 参数：shift：转移标志；keys : 按下的按键
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_HandleKeys( uint8 shift, uint8 keys )
{
}
/*********************************************************************************************
* 名称：zb_StartConfirm()
* 功能：当zstack协议栈启动完成后，执行这个函数
* 参数：status：启动完成后的状态
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_StartConfirm( uint8 status )
{
// If the device sucessfully started, change state to running
if ( status == ZB_SUCCESS ) // 建网成功
{
HalLedSet( HAL_LED_2, HAL_LED_MODE_ON );
}
else
{
}
}
/*********************************************************************************************
* 名称：zb_SendDataConfirm()
* 功能：发送数据确认
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_SendDataConfirm( uint8 handle, uint8 status )
{
}
/*********************************************************************************************
* 名称：zb_BindConfirm()
* 功能：绑定确认
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_BindConfirm( uint16 commandId, uint8 status )
{
}
/*********************************************************************************************
* 名称：zb_AllowBindConfirm()
* 功能：允许其他设备绑定
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_AllowBindConfirm( uint16 source )
{
}
/*********************************************************************************************
* 名称：zb_FindDeviceConfirm()
* 功能：查找设备完成后确定函数
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_FindDeviceConfirm( uint8 searchType, uint8 *searchKey, uint8 *result )
{
byte res;
if (ZB_IEEE_SEARCH == searchType) { //通过mac地址寻找对应的节点
osal_memcpy(res, searchKey, Z_EXTADDR_LEN);
res = result;
res = result;
MT_ReverseBytes( res, Z_EXTADDR_LEN );
zb_ReceiveDataIndication(0, 0x0101, 8+2,res);
}
if (ZB_NWKA_SEARCH == searchType) { //通过网络地址寻找对应的节点
res = searchKey;
res = searchKey;
osal_memcpy(res+2, result, Z_EXTADDR_LEN);
MT_ReverseBytes( res+2, Z_EXTADDR_LEN ); //mac地址反转
zb_ReceiveDataIndication(0, 0x0102, 8+2,res);//网络地址在前，mac地址在后发送给网关
}
}
/*********************************************************************************************
* 名称： zb_ReceiveDataIndication()
* 功能： 当zigbee接受到节点发送的数据后，调用这个函数
* 参数： source：源地址；commandID：命令ID；len：收到数据的长度；pData：收到的数据
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
void zb_ReceiveDataIndication( uint16 source, uint16 command, uint16 len, uint8 *pData)
{
HalLedSet( HAL_LED_1, HAL_LED_MODE_OFF );
HalLedSet( HAL_LED_1, HAL_LED_MODE_BLINK );
mtOSALSerialData_t* msg = (mtOSALSerialData_t*)osal_msg_allocate(sizeof(mtOSALSerialData_t)+len+4);
if (msg) {
msg->hdr.event = MT_SYS_APP_RSP_MSG;
msg->hdr.status = len+4;
msg->msg = (byte*)(msg+1);
msg->msg = (source>>8)&0xff;
msg->msg = source&0xff;
msg->msg = (command>>8)&0xff;
msg->msg = command&0xff;
osal_memcpy(msg->msg+4, pData, len);
osal_msg_send( MT_TaskID, (uint8 *)msg );
}
}
/*********************************************************************************************
* 名称：paramWrite()
* 功能：参数写入接口，老版本程序用
* 参数： pid:参数标识
* dat：写入缓存
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
static int paramWrite(uint16 pid, byte *dat)
{
int len = 0;
switch (pid) {
default:
break;
}
return len;
}
/*********************************************************************************************
* 名称：paramRead()
* 功能：参数读取接口，老版本程序用
* 参数： pid：参数标识
* dat: 读取缓存
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
static int paramRead(uint16 pid, byte *dat)
{
int len = 0;
switch (pid) {
case 0x0001:
dat = 0x12; dat = 0x09;
len = 2;
break;
case 0x0002:
dat = 0x11; dat = 0x44;
len = 2;
break;
case 0x0003:
dat = 0x00; dat = 0x01;
len = 2;
break;
case 0x0004:
dat = dat = dat = dat = dat = dat = 1;
len = 6;
break;
case 0x0005:
dat = DEV_ID_COLLECTOR;
len = 1;
break;
/* -----------网络参数 ------------------- */
case 0x0014: //mac地址
/*osal_nv_read( ZCD_NV_EXTADDR, 0, Z_EXTADDR_LEN, pBuf ); rm by liren */
ZMacGetReq( ZMacExtAddr, dat ); // add by liren
// Outgoing extended address needs to be reversed
MT_ReverseBytes( dat, Z_EXTADDR_LEN );
len = Z_EXTADDR_LEN;
break;
case 0x0015:
{
uint8 assocCnt = 0;
uint16 *assocList;
int i;
#if defined(RTR_NWK) && !defined( NONWK )
assocList = AssocMakeList( &assocCnt );
#else
assocCnt = 0;
assocList = NULL;
#endif
dat = assocCnt;
for (i=0; i<assocCnt&&i<16; i++) {
dat = HI_UINT16(assocList);
dat = LO_UINT16(assocList);
}
len = 1 + 2 * assocCnt;
break;
}
}
/* ------------------------------------ */
return len;
}
/*********************************************************************************************
* 名称：processCommand()
* 功能：zigbee命令处理函数
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
static void processCommand(uint16 cmd, byte *pData, uint8 len)
{
int i;
uint16 pid;
byte dat;
byte rlen = 1;
int ret;
switch (cmd) {
case 0x0000: //ZXBee数据
process_package((char*)pData, len);
break;
case 0x0101: //通过mac地址寻找对应的节点
{
uint8 *pExtAddr = pData;
MT_ReverseBytes( pExtAddr, Z_EXTADDR_LEN );
ZMacGetReq( ZMacExtAddr, dat ); //获取当前节点的mac地址
#if USE_SYS_FIND_DEVICE
zb_FindDeviceRequest(ZB_IEEE_SEARCH, pExtAddr);
#else
if (TRUE == osal_memcmp(pExtAddr, dat, Z_EXTADDR_LEN) || //如果mac地址匹配
TRUE == osal_memcmp(pData, "\x00\x00\x00\x00\x00\x00\x00\x00", Z_EXTADDR_LEN))
{
ret = 0;
zb_FindDeviceConfirm(ZB_IEEE_SEARCH, pExtAddr, (unsigned char *)&ret);
} else {
my_FindDevice(ZB_IEEE_SEARCH, pExtAddr);
}
#endif
}
break;
case 0x0102: //通过网络地址寻找对应的节点
{
uint16 shortAddr = (pData<<8) | pData;
uint16 sa = NLME_GetShortAddr(); //获取当前节点的网络地址
if (shortAddr == sa) { //如果网络地址匹配
ZMacGetReq( ZMacExtAddr, dat );//获取当前节点的mac地址
zb_FindDeviceConfirm(ZB_NWKA_SEARCH, (unsigned char *)&sa, dat);
} else {
#if USE_SYS_FIND_DEVICE
ZDP_IEEEAddrReq( shortAddr, ZDP_ADDR_REQTYPE_SINGLE, 0, 0 );
#else
my_FindDevice(ZB_NWKA_SEARCH, (uint8*)pData);
#endif
}
}
break;
case ID_CMD_WRITE_REQ: //老版本写入指令
for (i=0; i<len; i+=2) {
pid = pData<<8 | pData;
ret = paramWrite(pid, &pData);
if (ret <= 0) {
dat = 1;
zb_ReceiveDataIndication( 0, ID_CMD_WRITE_RES, 1, dat );
return;
}
i += ret;
}
dat = 0;
zb_ReceiveDataIndication( 0, ID_CMD_WRITE_RES, 1, dat);
break;
case ID_CMD_READ_REQ: //老版本读取指令
for (i=0; i<len; i+=2) {
pid = pData<<8 | pData;
dat = pData;
dat = pData;
ret = paramRead(pid, dat+rlen);
if (ret <= 0) {
dat = 1;
zb_ReceiveDataIndication( 0, ID_CMD_READ_RES, 1, dat );
return;
}
rlen += ret;
}
dat = 0;
zb_ReceiveDataIndication( 0, ID_CMD_READ_RES, rlen, dat );
break;
}
}
/*********************************************************************************************
* 名称：process_set_command_call()
* 功能：设置指令处理函数
* 参数：fun：指令处理函数
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
static void process_set_command_call(int (*fun)(char *ptag, char *pval, char *pout))
{
process_command_call = fun;
}
/*********************************************************************************************
* 名称：process_package()
* 功能：处理接收数据
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
static void process_package(char *pkg, int len)
{
char *p;
char *ptag = NULL;
char *pval = NULL;
char *pwbuf = wbuf+1;
if (pkg != '{' || pkg != '}') return;
pkg = 0;
p = pkg+1;
do {
ptag = p;
p = strchr(p, '=');
if (p != NULL) {
*p++ = 0;
pval = p;
p = strchr(p, ',');
if (p != NULL) *p++ = 0;
if (process_command_call != NULL) {
int ret;
ret = process_command_call(ptag, pval, pwbuf);
if (ret > 0) {
pwbuf += ret;
*pwbuf++ = ',';
}
}
}
} while (p != NULL);
if (pwbuf - wbuf > 1) {
wbuf = '{';
pwbuf = 0;
pwbuf[-1] = '}';
uint16 cmd = 0;
zb_ReceiveDataIndication( 0, cmd, pwbuf-wbuf, (uint8 *)wbuf );
}
}
/*********************************************************************************************
* 名称：process_command_callback()
* 功能：处理接收到的指令
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
int process_command_callback(char *ptag, char *pval, char *pout)
{
int val;
int ret = 0;
val = atoi(pval);
if (0 == strcmp("ECHO", ptag)) {
ret = sprintf(pout, "ECHO=%s",pval);
} else
if (0 == strcmp("PANID", ptag)) {
if (0 == strcmp("?", pval)) {
uint16 tmp16;
osal_nv_read( ZCD_NV_PANID, 0, sizeof( tmp16 ), &tmp16 );
ret = sprintf(pout, "PANID=%u", tmp16);
} else {
uint8 startOptions = ZCD_STARTOPT_DEFAULT_NETWORK_STATE;
uint16 tmp16;
osal_nv_read( ZCD_NV_PANID, 0, sizeof( tmp16 ), &tmp16 );
uint16 xval = atoi(pval);
if (tmp16 != xval) {
osal_nv_write(ZCD_NV_PANID, 0, osal_nv_item_len( ZCD_NV_PANID ), &xval);
zb_WriteConfiguration( ZCD_NV_STARTUP_OPTION, sizeof(uint8), &startOptions ); //标记网络状态发生改变
}
}
}
if (0 == strcmp("CHANNEL", ptag)) {
static uint32 chs[] = {0x00000800, 0x00001000, 0x00002000, 0x00004000, 0x00008000,
0x00010000, 0x00020000, 0x00040000,0x00080000,0x00100000,0x00200000,
0x00400000,0x00800000,0x01000000,0x02000000,0x04000000};
if (0 == strcmp("?", pval)) {
uint32 tmp32;
uint8 i;
osal_nv_read( ZCD_NV_CHANLIST, 0, sizeof( tmp32 ), &tmp32 );
for (i=0; i<16; i++) {
if (tmp32 == chs) break;
}
i += 11;
ret = sprintf(pout, "CHANNEL=%u", i);
} else {
uint32 tmp32, t32;
uint8 startOptions = ZCD_STARTOPT_DEFAULT_NETWORK_STATE;
tmp32 = val - 11;
osal_nv_read( ZCD_NV_CHANLIST, 0, sizeof( tmp32 ), &t32 );
if (tmp32 < 16) {
if (t32 != chs) {
osal_nv_write(ZCD_NV_CHANLIST, 0, osal_nv_item_len( ZCD_NV_CHANLIST ), &chs);
zb_WriteConfiguration( ZCD_NV_STARTUP_OPTION, sizeof(uint8), &startOptions ); //标记网络状态发生改变
}
}
}
}
/*if (0 == strcmp("RSSI", ptag)) {
if (0 == strcmp("?", pval)) {
ret = sprintf(pout, "RSSI=%d", rssi);
}
}*/
if (0 == strcmp("TYPE", ptag)) {
if (0 == strcmp("?", pval)) {
ret = sprintf(pout, "TYPE=%d%d%s", NODE_CATEGORY, logicalType, NODE_NAME);
}
}
if (0 == strcmp("TPN", ptag)) {
/*参数格式 x/y表示在y分钟内上报x次数据
*x = 0 停止上报,
*限制每分钟最大上报6次,最少上报1次
*/
char *s = strchr(pval, '/');
if (s != NULL) {
int v1, v2;
*s = 0;
v1 = atoi(pval);
v2 = atoi(s+1);
if (v1 > 0 && v2 > 0) {
_tm_delay = v2*60/v1;
if (_tm_delay >= 10 && _tm_delay <= 65) {
if (_tm_cnt == 0) {
// start timer
osal_start_timerEx( sapi_TaskID, __REPORT_EVT, (osal_rand()%_tm_delay) * 1000);
}
_tm_cnt = v1;
}
}
}
} //TMAN
return ret;
}
/*********************************************************************************************
* 名称：read_nb()
* 功能：查询邻居节点地址
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
static char* read_nb(char *buf, int len)
{
int i;
char *p;
buf = 0;
p = buf;
for (i=0; i<MAX_NEIGHBOR_ENTRIES; i++) {
neighborEntry_t *pnb = &neighborTable;
if (pnb->panId == panid
&& memcmp(pnb->neighborExtAddr,"\x00\x00\x00\x00\x00\x00\x00\x00", 8)!=0
&& pnb->age <= NWK_ROUTE_AGE_LIMIT) {
sprintf(p, "%02X%02X", pnb->neighborExtAddr, pnb->neighborExtAddr);
p = p + strlen(p);
}
}
return buf;
}
/*********************************************************************************************
* 名称：my_report_proc()
* 功能：节点网络信息上报处理
* 参数：
* 返回：
* 修改：
* 注释：
*********************************************************************************************/
static void my_report_proc(void)
{
sprintf(wbuf, "{PN=");
//read_al(wbuf+strlen(wbuf), -1);
read_nb(wbuf+strlen(wbuf), -1);
if (strlen(wbuf) == 4) {
sprintf(wbuf+4, "NULL");
}
sprintf(wbuf+strlen(wbuf), ",TYPE=%d%d%s}", NODE_CATEGORY, logicalType, NODE_NAME);
zb_ReceiveDataIndication(0/*source*/, 0/*cmd*/, strlen(wbuf), (uint8*)wbuf);
}
页:
[1]