Yuneec ST24解码器C语言源码

Yuneec ST24地面站与接收机之间通信数据包解码的C语言源代码。 RC protocol implementation for Yuneec ST24 transmitter.

/****************************************************************************
 *
 *   Copyright （c） 2014 PX4 Development Team. All rights reserved.
 *
 * Redistribution and use in source and binary forms with or without
 * modification are permitted provided that the following conditions
 * are met:
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the
 *    distribution.
 * 3. Neither the name PX4 nor the names of its contributors may be
 *    used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * “AS IS“ AND ANY EXPRESS OR IMPLIED WARRANTIES INCLUDING BUT NOT
 * LIMITED TO THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT INDIRECT
 * INCIDENTAL SPECIAL EXEMPLARY OR CONSEQUENTIAL DAMAGES （INCLUDING
 * BUT NOT LIMITED TO PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
 * OF USE DATA OR PROFITS; OR BUSINESS INTERRUPTION） HOWEVER CAUSED
 * AND ON ANY THEORY OF LIABILITY WHETHER IN CONTRACT STRICT
 * LIABILITY OR TORT （INCLUDING NEGLIGENCE OR OTHERWISE） ARISING IN
 * ANY WAY OUT OF THE USE OF THIS SOFTWARE EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 *
 ****************************************************************************/

/*
 * @file st24.h
 *
 * RC protocol implementation for Yuneec ST24 transmitter.
 *
 * @author Lorenz Meier 
 */

#include 
#include 
#include “st24.h“
#include “common_rc.h“

const char *decode_states[] = {“UNSYNCED“
			       “GOT_STX1“
			       “GOT_STX2“
			       “GOT_LEN“
			       “GOT_TYPE“
			       “GOT_DATA“
			      };

/* define range mapping here -+100% -> 1000..2000 */
#define ST24_RANGE_MIN 500.0f
#define ST24_RANGE_MAX 3500.0f

#define ST24_TARGET_MIN 1000.0f
#define ST24_TARGET_MAX 2000.0f

/* pre-calculate the floating point stuff as far as possible at compile time */
#define ST24_SCALE_FACTOR （（ST24_TARGET_MAX - ST24_TARGET_MIN） / （ST24_RANGE_MAX - ST24_RANGE_MIN））
#define ST24_SCALE_OFFSET （int）（ST24_TARGET_MIN - （ST24_SCALE_FACTOR * ST24_RANGE_MIN + 0.5f））

static enum ST24_DECODE_STATE _decode_state = ST24_DECODE_STATE_UNSYNCED;
static uint8_t _rxlen;

static ReceiverFcPacket &_rxpacket = rc_decode_buf._strxpacket;

uint8_t st24_common_crc8（uint8_t *ptr uint8_t len）
{
	uint8_t i crc ;
	crc = 0;

	while （len--） {
		for （i = 0x80; i != 0; i >>= 1） {
			if （（crc & 0x80） != 0） {
				crc <<= 1;
				crc ^= 0x07;

			} else {
				crc <<= 1;
			}

			if （（*ptr & i） != 0） {
				crc ^= 0x07

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件       6164  2019-11-24 16:19  st24.h

     文件       7253  2019-11-24 12:22  st24.cpp

----------- ---------  ---------- -----  ----

                13417                    2