HeightmapShape.hh

Go to the documentation of this file.

/*
 * Copyright (C) 2012-2016 Open Source Robotics Foundation
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
*/
/* Desc: Heightmap shape
 * Author: Nate Koenig, Andrew Howard
 * Date: 8 May 2003
 */

#ifndef _HEIGHTMAPSHAPE_HH_
#define _HEIGHTMAPSHAPE_HH_

#include <string>
#include <vector>

#include "gazebo/common/ImageHeightmap.hh"
#include "gazebo/common/HeightmapData.hh"
#include "gazebo/common/Dem.hh"
#include "gazebo/math/Vector3.hh"
#include "gazebo/transport/TransportTypes.hh"
#include "gazebo/physics/PhysicsTypes.hh"
#include "gazebo/physics/Shape.hh"
#include "gazebo/util/system.hh"

namespace gazebo
{
  namespace physics
  {

    class GZ_PHYSICS_VISIBLE HeightmapShape : public Shape
    {
      public: explicit HeightmapShape(CollisionPtr _parent);

      public: virtual ~HeightmapShape();

      public: virtual void Load(sdf::ElementPtr _sdf);

      public: virtual void Init();

      public: virtual void SetScale(const math::Vector3 &_scale);

      public: std::string GetURI() const;

      public: math::Vector3 GetSize() const;

      public: math::Vector3 GetPos() const;

      public: math::Vector2i GetVertexCount() const;

      public: float GetHeight(int _x, int _y) const;

      public: void FillMsg(msgs::Geometry &_msg);

      public: virtual void ProcessMsg(const msgs::Geometry &_msg);

      public: virtual double ComputeVolume() const;

      public: float GetMaxHeight() const;

      public: float GetMinHeight() const;

      public: int GetSubSampling() const;

      public: common::Image GetImage() const;

      private: int LoadTerrainFile(const std::string &_filename);

      #ifdef HAVE_GDAL
      private: int LoadDEMAsTerrain(const std::string &_filename);
      #endif

      private: int LoadImageAsTerrain(const std::string &_filename);

      private: void OnRequest(ConstRequestPtr &_msg);

      protected: std::vector<float> heights;

      protected: common::ImageHeightmap img;

      protected: common::HeightmapData *heightmapData;

      protected: unsigned int vertSize;

      protected: bool flipY;

      protected: int subSampling;

      private: transport::NodePtr node;

      private: transport::SubscriberPtr requestSub;

      private: transport::PublisherPtr responsePub;

      private: std::string fileFormat;

      private: math::Vector3 heightmapSize;

      #ifdef HAVE_GDAL
      private: common::Dem dem;
      #endif
    };
  }
}
#endif