diff --git a/source/RobotAPI/drivers/OrientedTactileSensor/OrientedTactileSensorUnit.h.orig b/source/RobotAPI/drivers/OrientedTactileSensor/OrientedTactileSensorUnit.h.orig deleted file mode 100644 index a10822f8e98f1bcbb85d4ed3fd76c2a5810497b6..0000000000000000000000000000000000000000 --- a/source/RobotAPI/drivers/OrientedTactileSensor/OrientedTactileSensorUnit.h.orig +++ /dev/null @@ -1,169 +0,0 @@ -#ifndef SENSORPACKAGEUNIT_H -#define SENSORPACKAGEUNIT_H - -#include <ArmarXCore/core/Component.h> -#include <RobotAPI/interface/units/UnitInterface.h> -#include <RobotAPI/interface/units/OrientedTactileSensorUnit.h> -#include <ArmarXCore/core/services/tasks/PeriodicTask.h> -#include <ArmarXCore/core/services/tasks/RunningTask.h> -#include <netinet/in.h> -#include <iostream> -#include <fstream> -#include <stdio.h> -#include <boost/date_time/posix_time/posix_time.hpp> -#include <Eigen/Dense> -#include <RobotAPI/libraries/SimpleJsonLogger/SimpleJsonLogger.h> - -namespace armarx -{ - class OrientedTactileSensorUnitPropertyDefinitions: - public ComponentPropertyDefinitions - { - public: - OrientedTactileSensorUnitPropertyDefinitions(std::string prefix): - ComponentPropertyDefinitions(prefix) - { - defineOptionalProperty<std::string>( - "SerialInterfaceDevice", - "/dev/ttyACM0", - "The serial device the arduino is connected to."); - - defineOptionalProperty<std::string>( - "TopicName", - "OrientedTactileSensorValues", - "Name of the topic on which the sensor values are provided"); - - defineOptionalProperty<std::string>( - "CalibrationData", - "65524 3 12 65534 65534 1 1208 119 58726 1000 943 ", - "Sensor Register Data to calibrate the sensor"); - - defineOptionalProperty<std::size_t>( - "SamplesRotation", - 20, - "number of orientation values to differentiate"); - - defineOptionalProperty<std::size_t>( - "SamplesPressure", - 10, - "number of pressure values to differentiate"); - - defineOptionalProperty<std::size_t>( - "SamplesAcceleration", - 20, - "number of pressure values to differentiate"); - - defineOptionalProperty<bool>( - "logData", - "false", - "log data from sensor"); - defineOptionalProperty<bool>( - "calibrateSensor", - "false" - "Set true to calibrate the sensor and get calibration data and false to use existent calibration data"); - } - - }; - - /** - * @class OrientedTactileSensorUnit - * @brief ArmarX wrapper for an arduino due with one BNO055 IMU and one BMP280 pressure sensor - * - */ - class OrientedTactileSensorUnit: - virtual public armarx::Component - //TODO: needs interface to send calibration data - { - public: - OrientedTactileSensorUnit(); - - virtual std::string getDefaultName() const - { - return "OrientedTactileSensorUnit"; - } - - struct SensorData - { - int id; - float pressure; - float qw, qx, qy, qz; - float accelx, accely, accelz; - }; - - struct CalibrationData - { - int accel_offset_x, accel_offset_y, accel_offset_z, gyro_offset_x, gyro_offset_y, gyro_offset_z, mag_offset_x, mag_offset_y, mag_offset_z, accel_radius, mag_radius; - }; - - struct PressureRate - { - IceUtil::Time timestamp; - float pressure; - }; - - struct RotationRate - { - IceUtil::Time timestamp; - Eigen::Quaternionf orientation; - }; - - struct AccelerationRate - { - IceUtil::Time timestamp; - float rotationRate; - }; - struct LinAccRate - { - IceUtil::Time timestamp; - float accx, accy, accz; - }; - - protected: - virtual void onInitComponent(); - virtual void onConnectComponent(); - - virtual PropertyDefinitionsPtr createPropertyDefinitions(); - - private: - std::ifstream arduinoIn; - std::ofstream arduinoOut; - RunningTask<OrientedTactileSensorUnit>::pointer_type readTask; - OrientedTactileSensorUnitListenerPrx topicPrx; - OrientedTactileSensorUnitInterfacePrx interfacePrx; - - void run(); - SensorData getValues(std::string line); - bool getCalibrationValues(std::string line); - bool loadCalibration(); - int fd; - CalibrationData calibration; - - Eigen::Quaternionf inverseOrientation; - std::vector<RotationRate> samplesRotation; - std::vector<PressureRate> samplesPressure; - std::vector<AccelerationRate> samplesAcceleration; -<<<<<<< HEAD - std::vector<float> pressureRates; - int maxSamplesRotation; - int sampleIndexRotation; - int maxSamplesPressure; - int sampleIndexPressure; - int maxSamplesAcceleration; - int sampleIndexAcceleration; - int sampleIndexPressureRate; - float sumPressureRates; - bool first; - int i = 0; - SimpleJsonLoggerPtr logger; - std::string prefix; -======= - std::size_t maxSamplesRotation; - std::size_t sampleIndexRotation; - std::size_t maxSamplesPressure; - std::size_t sampleIndexPressure; - std::size_t maxSamplesAcceleration; - std::size_t sampleIndexAcceleration; ->>>>>>> master - }; -} -#endif // SENSORPACKAGEUNIT_H