io_ctrl.rar_ATMEGA88

/** * @file protocol.c * * @brief functions about protocol * * $Id: protocol.c 2012-5-17 13:22:35 wdx $ * * @author humtech Corporation: http://www.humtech.com * @author Support email: [email protected] */ /* * Copyright (c) 2010, humtech Corporation All rights reserved. * * Licensed under humtech's Limited License Agreement --> LICENSE.txt */ /* === INCLUDES ============================================================ */ #include <stdint.h> #include <ioavr.h> #include <string.h> #include <ina90.h> #include "protocol.h" #include "uart.h" #include "crc.h" #include "io.h" #include "app.h" #include "timer.h" /* === TYPES =============================================================== */ /* === MACROS ============================================================== */ #define LOCAL_ADDR (0x01) #define MAX_HOLD_REG (0x02) #define DEV_TYPE (0x02) #define DEV_NO (0x01) #define SENSOR_NO (0x00) #define SNSOR_HOLD_REG_NO (0x00) #define HOLD_START_ADDR (49900) /*define modbus command*/ #define READ_COIL_STAT (0x01) #define READ_HOLD_REG (0x03) #define FORC_SNGLE_COIL (0x05) /* === GLOBALS ============================================================= */ static uint8_t pro_len; static uint8_t pro_rx_buf[RX_BUF_LEN]; static uint8_t pro_tx_buf[TX_BUF_LEN]; static uint16_t hold_reg_val[MAX_HOLD_REG]; /* === PROTOTYPES ========================================================== */ uint8_t chk_rcv_dat(void); void set_single_coil_stat(uint16_t reg_addr,uint16_t dat); void read_coil_stat(uint16_t addr,uint16_t no); void read_hold_reg(uint16_t reg_addr,uint16_t reg_no); /* === IMPLEMENTATION ====================================================== */ /*set hold register initial value*/ void init_protocol(void) { hold_reg_val[0] = (DEV_TYPE << 8) | DEV_NO;//0X0201 hold_reg_val[1] = (SNSOR_HOLD_REG_NO << 8) | SENSOR_NO;//0x0000 } /** * @brief the handler of protocol * * @para none * * @return none */ void protocol_handler(void) { uint8_t chk_status; uint8_t cmd; uint16_t reg_addr,dat; uint16_t reg_no; if(uart_rcv_flag == TRUE) { /*reset uart recive flag*/ uart_rcv_flag = FALSE; /*save uart receive data length*/ memcpy(pro_rx_buf,rx_buf,uart_rx_cnt); pro_len = uart_rx_cnt; uart_rx_cnt = 0x00; /*check receive data valid*/ chk_status = chk_rcv_dat(); if(chk_status == TRUE) { led_rx_cnt = LED_TIM_OV; LED_RX_ON(); cmd = pro_rx_buf[1]; switch(cmd) { case READ_COIL_STAT: { reg_addr = (pro_rx_buf[2]<<8) | pro_rx_buf[3]; reg_no = (pro_rx_buf[4]<<8) | pro_rx_buf[5]; read_coil_stat(reg_addr,reg_no); break; } case READ_HOLD_REG: { reg_addr = (pro_rx_buf[2]<<8) | pro_rx_buf[3]; reg_no = (pro_rx_buf[4]<<8) | pro_rx_buf[5]; read_hold_reg(reg_addr,reg_no); break; } case FORC_SNGLE_COIL: { reg_addr = (pro_rx_buf[2]<<8) | pro_rx_buf[3]; dat = (pro_rx_buf[4]<<8) | pro_rx_buf[5]; set_single_coil_stat(reg_addr,dat); break; } } } } } /** * @brief check receiv data valid * * @para none * * @return none */ uint8_t chk_rcv_dat(void) { uint16_t crc16_val; if(pro_len == 0x00) { return FALSE; } if(pro_rx_buf[0] != LOCAL_ADDR) { return FALSE; } crc16_val = crc16(pro_rx_buf,pro_len-2); if((pro_rx_buf[pro_len-2] != ((crc16_val>>8)&0x00FF) | (pro_rx_buf[pro_len-1] != (crc16_val&0x00FF))) ) { return FALSE; } return TRUE; } /** * @brief read coil state * * @para reg_addr the register address of coil * no no. of reading coil * @return none */ void read_coil_stat(uint16_t reg_addr,uint16_t reg_no) { uint16_t crc16_val; uint8_t index = 0; /*check register address valid*/ if(reg_no > MAX_COIL) { return; } pro_tx_buf[index++] = LOCAL_ADDR; /*first byte: local address */ pro_tx_buf[index++] = READ_COIL_STAT; /*second byte: command */ pro_tx_buf[index++] = 1; /*third byte: data feild length */ pro_tx_buf[index++] = coil_sta[0]; crc16_val = crc16(pro_tx_buf,index); /*calculate crc value */ pro_tx_buf[index++] = (crc16_val>>8)&0X00FF; pro_tx_buf[index++] = crc16_val & 0x00FF; uart_send_dat(pro_tx_buf,index); /*send data by uart */ } /** * @brief read holding reg * * @para reg_addr the register address of coil * no no. of reading coil * @return none */ void read_hold_reg(uint16_t reg_addr,uint16_t reg_no) { uint16_t crc16_val; uint8_t index = 0; uint8_t start_addr; uint8_t i,len; /*check register address valid*/ if(reg_no > MAX_HOLD_REG) { return; } if(reg_addr < HOLD_START_ADDR) { return; } /*build tx data buf*/ pro_tx_buf[index++] = LOCAL_ADDR; /*first byte: local address */ pro_tx_buf[index++] = READ_HOLD_REG; /*second byte: command */ pro_tx_buf[index++] = 0; /*third byte: data feild length */ len = index; start_addr = reg_addr - HOLD_START_ADDR; for(i = 0; i < reg_no;i++) { pro_tx_buf[index++] = hold_reg_val[start_addr]>>8; pro_tx_buf[index++] = hold_reg_val[start_addr++] & 0x00FF; } len = index - len; pro_tx_buf[2] = len; crc16_val = crc16(pro_tx_buf,index); /*calculate crc value */ pro_tx_buf[index++] = crc16_val>>8; pro_tx_buf[index++] = crc16_val & 0xFF; uart_send_dat(pro_tx_buf,index); /*send data by uart */ } /** * @brief set single coil state * * @para reg_addr the register address of coil * dat state of set coil * @return none */ void set_single_coil_stat(uint16_t reg_addr,uint16_t dat) { //check register address valid if(reg_addr > MAX_COIL) { return; } if(dat == 0xFF00) { FAN_OPEN(); coil_sta[0] = 0x01; } else { FAN_CLOSE(); coil_sta[0] = 0x00; } uart_send_dat(pro_rx_buf,pro_len); }