/****************************************************************************
?*
?*???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