PX4 Firmware
PX4 Autopilot Software http://px4.io
tfmini_parser.h
Go to the documentation of this file.
1
/****************************************************************************
2
*
3
* Copyright (c) 2017-2019 PX4 Development Team. All rights reserved.
4
*
5
* Redistribution and use in source and binary forms, with or without
6
* modification, are permitted provided that the following conditions
7
* are met:
8
*
9
* 1. Redistributions of source code must retain the above copyright
10
* notice, this list of conditions and the following disclaimer.
11
* 2. Redistributions in binary form must reproduce the above copyright
12
* notice, this list of conditions and the following disclaimer in
13
* the documentation and/or other materials provided with the
14
* distribution.
15
* 3. Neither the name PX4 nor the names of its contributors may be
16
* used to endorse or promote products derived from this software
17
* without specific prior written permission.
18
*
19
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
21
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
22
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
23
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
24
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
25
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
26
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
27
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30
* POSSIBILITY OF SUCH DAMAGE.
31
*
32
****************************************************************************/
33
34
/**
35
* @file modified from sf0x_parser.cpp
36
* @author Lorenz Meier <lm@inf.ethz.ch>
37
* @author Chuong Nguyen <chnguye7@asu.edu>
38
* @author Ayush Gaud <ayush.gaud@gmail.com>
39
*
40
* Declarations of parser for the Benewake TFmini laser rangefinder series
41
*/
42
43
#pragma once
44
45
// Data Format for Benewake TFmini
46
// ===============================
47
// 9 bytes total per message:
48
// 1) 0x59
49
// 2) 0x59
50
// 3) Dist_L (low 8bit)
51
// 4) Dist_H (high 8bit)
52
// 5) Strength_L (low 8bit)
53
// 6) Strength_H (high 8bit)
54
// 7) Reserved bytes
55
// 8) Original signal quality degree
56
// 9) Checksum parity bit (low 8bit), Checksum = Byte1 + Byte2 +...+Byte8. This is only a low 8bit though
57
58
59
enum class
TFMINI_PARSE_STATE
{
60
STATE0_UNSYNC
= 0,
61
STATE1_SYNC_1
,
62
STATE1_SYNC_2
,
63
STATE2_GOT_DIST_L
,
64
STATE2_GOT_DIST_H
,
65
STATE3_GOT_STRENGTH_L
,
66
STATE3_GOT_STRENGTH_H
,
67
STATE4_GOT_RESERVED
,
68
STATE5_GOT_QUALITY
,
69
STATE6_GOT_CHECKSUM
70
};
71
72
int
tfmini_parse
(
char
c,
char
*parserbuf,
unsigned
*parserbuf_index,
TFMINI_PARSE_STATE
*
state
,
float
*dist);
TFMINI_PARSE_STATE::STATE0_UNSYNC
TFMINI_PARSE_STATE
TFMINI_PARSE_STATE
Definition:
tfmini_parser.h:59
state
static enum @74 state
TFMINI_PARSE_STATE::STATE2_GOT_DIST_L
TFMINI_PARSE_STATE::STATE2_GOT_DIST_H
TFMINI_PARSE_STATE::STATE1_SYNC_2
TFMINI_PARSE_STATE::STATE1_SYNC_1
TFMINI_PARSE_STATE::STATE3_GOT_STRENGTH_H
TFMINI_PARSE_STATE::STATE4_GOT_RESERVED
TFMINI_PARSE_STATE::STATE5_GOT_QUALITY
TFMINI_PARSE_STATE::STATE6_GOT_CHECKSUM
TFMINI_PARSE_STATE::STATE3_GOT_STRENGTH_L
tfmini_parse
int tfmini_parse(char c, char *parserbuf, unsigned *parserbuf_index, TFMINI_PARSE_STATE *state, float *dist)
Definition:
tfmini_parser.cpp:66
src
drivers
distance_sensor
tfmini
tfmini_parser.h
Generated by
1.8.13