00001 #ifndef YOUBOT_YOUBOTGRIPPER_H 00002 #define YOUBOT_YOUBOTGRIPPER_H 00003 00004 /**************************************************************** 00005 * 00006 * Copyright (c) 2011 00007 * All rights reserved. 00008 * 00009 * Hochschule Bonn-Rhein-Sieg 00010 * University of Applied Sciences 00011 * Computer Science Department 00012 * 00013 * +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 00014 * 00015 * Author: 00016 * Jan Paulus, Nico Hochgeschwender, Michael Reckhaus, Azamat Shakhimardanov 00017 * Supervised by: 00018 * Gerhard K. Kraetzschmar 00019 * 00020 * +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 00021 * 00022 * This sofware is published under a dual-license: GNU Lesser General Public 00023 * License LGPL 2.1 and BSD license. The dual-license implies that users of this 00024 * code may choose which terms they prefer. 00025 * 00026 * +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 00027 * 00028 * Redistribution and use in source and binary forms, with or without 00029 * modification, are permitted provided that the following conditions are met: 00030 * 00031 * * Redistributions of source code must retain the above copyright 00032 * notice, this list of conditions and the following disclaimer. 00033 * * Redistributions in binary form must reproduce the above copyright 00034 * notice, this list of conditions and the following disclaimer in the 00035 * documentation and/or other materials provided with the distribution. 00036 * * Neither the name of the Hochschule Bonn-Rhein-Sieg nor the names of its 00037 * contributors may be used to endorse or promote products derived from 00038 * this software without specific prior written permission. 00039 * 00040 * This program is free software: you can redistribute it and/or modify 00041 * it under the terms of the GNU Lesser General Public License LGPL as 00042 * published by the Free Software Foundation, either version 2.1 of the 00043 * License, or (at your option) any later version or the BSD license. 00044 * 00045 * This program is distributed in the hope that it will be useful, 00046 * but WITHOUT ANY WARRANTY; without even the implied warranty of 00047 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 00048 * GNU Lesser General Public License LGPL and the BSD license for more details. 00049 * 00050 * You should have received a copy of the GNU Lesser General Public 00051 * License LGPL and BSD license along with this program. 00052 * 00053 ****************************************************************/ 00054 #include <vector> 00055 #include <sstream> 00056 #include <youbot_driver/generic/Logger.hpp> 00057 #include <youbot_driver/generic/Units.hpp> 00058 #include <youbot_driver/generic/Time.hpp> 00059 #include <youbot_driver/generic/Exceptions.hpp> 00060 #include <youbot_driver/youbot/ProtocolDefinitions.hpp> 00061 #include <youbot_driver/youbot/EthercatMaster.hpp> 00062 #include <youbot_driver/youbot/EthercatMasterInterface.hpp> 00063 #include <youbot_driver/youbot/EthercatMasterWithThread.hpp> 00064 #include <youbot_driver/youbot/EthercatMasterWithoutThread.hpp> 00065 #include <youbot_driver/youbot/YouBotSlaveMsg.hpp> 00066 #include <youbot_driver/youbot/YouBotSlaveMailboxMsg.hpp> 00067 #include <youbot_driver/generic-gripper/Gripper.hpp> 00068 #include <youbot_driver/generic-gripper/GripperData.hpp> 00069 #include <youbot_driver/generic-gripper/GripperParameter.hpp> 00070 #include <youbot_driver/one-dof-gripper/OneDOFGripper.hpp> 00071 #include <youbot_driver/one-dof-gripper/OneDOFGripperData.hpp> 00072 #include <youbot_driver/youbot/YouBotGripperParameter.hpp> 00073 #include <youbot_driver/youbot/YouBotGripperBar.hpp> 00074 #include <boost/scoped_ptr.hpp> 00075 00076 namespace youbot 00077 { 00078 00082 class YouBotGripper : public OneDOFGripper 00083 { 00084 public: 00085 YouBotGripper(const unsigned int jointNo, const std::string& configFilePath); 00086 00087 virtual ~YouBotGripper(); 00088 00089 protected: 00090 virtual void getConfigurationParameter(GripperParameter& parameter) const; 00091 00092 virtual void setConfigurationParameter(const GripperParameter& parameter); 00093 00094 public: 00095 virtual void getConfigurationParameter(GripperFirmwareVersion& parameter) const; 00096 00097 virtual void setConfigurationParameter(const CalibrateGripper& parameter); 00098 00099 virtual void getConfigurationParameter(YouBotSlaveMailboxMsg& parameter) const; 00100 00101 protected: 00102 virtual void getData(const GripperData& data) const; 00103 00104 virtual void setData(const GripperData& data); 00105 00106 virtual void getData(OneDOFGripperData& data) const; 00107 00108 virtual void setData(const OneDOFGripperData& data); 00109 00110 public: 00111 virtual void setData(const GripperBarSpacingSetPoint& barSpacing); 00112 00113 virtual void getData(GripperSensedBarSpacing& barSpacing) const; 00114 00115 void open(); 00116 00117 void close(); 00118 00119 YouBotGripperBar& getGripperBar1(); 00120 00121 YouBotGripperBar& getGripperBar2(); 00122 00123 private: 00124 YouBotGripper(const YouBotGripper & source); 00125 00126 YouBotGripper & operator=(const YouBotGripper & source); 00127 00128 void parseMailboxStatusFlags(const YouBotSlaveMailboxMsg& mailboxMsg) const; 00129 00130 bool setValueToMotorContoller(const YouBotSlaveMailboxMsg& mailboxMsg) const; 00131 00132 bool retrieveValueFromMotorContoller(YouBotSlaveMailboxMsg& message) const; 00133 00134 EthercatMasterInterface* ethercatMaster; 00135 00136 unsigned int timeTillNextMailboxUpdate; 00137 00138 unsigned int mailboxMsgRetries; 00139 00140 unsigned int jointNumber; 00141 00142 boost::scoped_ptr<YouBotGripperBar> bar1; 00143 00144 boost::scoped_ptr<YouBotGripperBar> bar2; 00145 00146 }; 00147 00148 } // namespace youbot 00149 #endif