PX4 Firmware
PX4 Autopilot Software http://px4.io
PX4Rangefinder.hpp
Go to the documentation of this file.
1 /****************************************************************************
2  *
3  * Copyright (c) 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 #pragma once
35 
36 #include <drivers/drv_hrt.h>
38 #include <lib/cdev/CDev.hpp>
40 #include <uORB/uORB.h>
43 
44 class PX4Rangefinder : public cdev::CDev
45 {
46 
47 public:
48  PX4Rangefinder(const uint32_t device_id,
49  const uint8_t priority = ORB_PRIO_DEFAULT,
50  const uint8_t device_orientation = distance_sensor_s::ROTATION_DOWNWARD_FACING);
51  ~PX4Rangefinder() override;
52 
53  void print_status();
54 
55  void set_device_type(uint8_t device_type);
56  //void set_error_count(uint64_t error_count) { _distance_sensor_pub.get().error_count = error_count; }
57 
58  void set_device_id(const uint8_t device_id) { _distance_sensor_pub.get().id = device_id; };
59 
60  void set_fov(const float fov) { set_hfov(fov); set_vfov(fov); }
61  void set_hfov(const float fov) { _distance_sensor_pub.get().h_fov = fov; }
62  void set_vfov(const float fov) { _distance_sensor_pub.get().v_fov = fov; }
63 
64  void set_max_distance(const float distance) { _distance_sensor_pub.get().max_distance = distance; }
65  void set_min_distance(const float distance) { _distance_sensor_pub.get().min_distance = distance; }
66 
67  void set_orientation(const uint8_t device_orientation = distance_sensor_s::ROTATION_DOWNWARD_FACING);
68 
69  void update(const hrt_abstime timestamp, const float distance, const int8_t quality = -1);
70 
71 private:
72 
74 
76 
77 };
void set_max_distance(const float distance)
~PX4Rangefinder() override
void set_hfov(const float fov)
void set_fov(const float fov)
API for the uORB lightweight object broker.
void set_vfov(const float fov)
static int32_t device_id[max_accel_sens]
Vector rotation library.
High-resolution timer with callouts and timekeeping.
void set_device_type(uint8_t device_type)
uORB::PublicationMultiData< distance_sensor_s > _distance_sensor_pub
void update(const hrt_abstime timestamp, const float distance, const int8_t quality=-1)
Abstract class for any character device.
Definition: CDev.hpp:58
void set_min_distance(const float distance)
PX4Rangefinder(const uint32_t device_id, const uint8_t priority=ORB_PRIO_DEFAULT, const uint8_t device_orientation=distance_sensor_s::ROTATION_DOWNWARD_FACING)
__BEGIN_DECLS typedef uint64_t hrt_abstime
Absolute time, in microsecond units.
Definition: drv_hrt.h:58
void set_device_id(const uint8_t device_id)
void set_orientation(const uint8_t device_orientation=distance_sensor_s::ROTATION_DOWNWARD_FACING)