imu_sensor_controller.h
Go to the documentation of this file.
1 // Copyright (C) 2012, hiDOF INC.
3 // Copyright (C) 2013, PAL Robotics S.L.
4 //
5 // Redistribution and use in source and binary forms, with or without
6 // modification, are permitted provided that the following conditions are met:
7 // * Redistributions of source code must retain the above copyright notice,
8 // this list of conditions and the following disclaimer.
9 // * Redistributions in binary form must reproduce the above copyright
10 // notice, this list of conditions and the following disclaimer in the
11 // documentation and/or other materials provided with the distribution.
12 // * Neither the name of PAL Robotics S.L. nor the names of its
13 // contributors may be used to endorse or promote products derived from
14 // this software without specific prior written permission.
15 //
16 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
17 // AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 // IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 // ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
20 // LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 // CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 // SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 // INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 // CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 // ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 // POSSIBILITY OF SUCH DAMAGE.
28 
30 
31 #ifndef IMU_SENSOR_CONTROLLER_IMU_SENSOR_CONTROLLER_H
32 #define IMU_SENSOR_CONTROLLER_IMU_SENSOR_CONTROLLER_H
33 
37 #include <sensor_msgs/Imu.h>
39 #include <boost/shared_ptr.hpp>
40 
42 {
43 
44 // this controller gets access to the ImuSensorInterface
45 class ImuSensorController: public controller_interface::Controller<hardware_interface::ImuSensorInterface>
46 {
47 public:
49 
50  virtual bool init(hardware_interface::ImuSensorInterface* hw, ros::NodeHandle &root_nh, ros::NodeHandle& controller_nh);
51  virtual void starting(const ros::Time& time);
52  virtual void update(const ros::Time& time, const ros::Duration& /*period*/);
53  virtual void stopping(const ros::Time& /*time*/);
54 
55 private:
56  std::vector<hardware_interface::ImuSensorHandle> sensors_;
58  std::vector<RtPublisherPtr> realtime_pubs_;
59  std::vector<ros::Time> last_publish_times_;
60  double publish_rate_;
61 };
62 
63 }
64 
65 #endif
virtual void update(const ros::Time &time, const ros::Duration &)
boost::shared_ptr< realtime_tools::RealtimePublisher< sensor_msgs::Imu > > RtPublisherPtr
virtual bool init(hardware_interface::ImuSensorInterface *hw, ros::NodeHandle &root_nh, ros::NodeHandle &controller_nh)
std::vector< RtPublisherPtr > realtime_pubs_
std::vector< hardware_interface::ImuSensorHandle > sensors_
virtual void starting(const ros::Time &time)


imu_sensor_controller
Author(s): Adolfo Rodriguez Tsouroukdissian
autogenerated on Sat Apr 18 2020 03:58:16