mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-19 00:41:43 +00:00
05626cfafe
* Fixed cpplint.py [build/include_order] and [build/include_what_you_use] warnings * Fixed cpplint.py [readability/casting] warnings * Updated .styleguide format * Fixed cpplint.py [build/header_guard] warnings
38 lines
1.1 KiB
C++
38 lines
1.1 KiB
C++
/*----------------------------------------------------------------------------*/
|
|
/* Copyright (c) FIRST 2014-2016. All Rights Reserved. */
|
|
/* Open Source Software - may be modified and shared by FRC teams. The code */
|
|
/* must be accompanied by the FIRST BSD license file in the root directory of */
|
|
/* the project. */
|
|
/*----------------------------------------------------------------------------*/
|
|
|
|
#pragma once
|
|
|
|
#include <string>
|
|
|
|
#include <gazebo/common/Time.hh>
|
|
#include <gazebo/transport/transport.hh>
|
|
|
|
#include "simulation/gz_msgs/msgs.h"
|
|
|
|
using namespace gazebo;
|
|
|
|
class SimEncoder {
|
|
public:
|
|
explicit SimEncoder(std::string topic);
|
|
|
|
void Reset();
|
|
void Start();
|
|
void Stop();
|
|
double GetPosition();
|
|
double GetVelocity();
|
|
|
|
private:
|
|
void sendCommand(std::string cmd);
|
|
|
|
double position, velocity;
|
|
transport::SubscriberPtr posSub, velSub;
|
|
transport::PublisherPtr commandPub;
|
|
void positionCallback(const msgs::ConstFloat64Ptr& msg);
|
|
void velocityCallback(const msgs::ConstFloat64Ptr& msg);
|
|
};
|