00001 /*************************************************************************** 00002 * Copyright (C) 2005 by Robot Group Leipzig * 00003 * martius@informatik.uni-leipzig.de * 00004 * fhesse@informatik.uni-leipzig.de * 00005 * der@informatik.uni-leipzig.de * 00006 * * 00007 * This program is free software; you can redistribute it and/or modify * 00008 * it under the terms of the GNU General Public License as published by * 00009 * the Free Software Foundation; either version 2 of the License, or * 00010 * (at your option) any later version. * 00011 * * 00012 * This program is distributed in the hope that it will be useful, * 00013 * but WITHOUT ANY WARRANTY; without even the implied warranty of * 00014 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * 00015 * GNU General Public License for more details. * 00016 * * 00017 * You should have received a copy of the GNU General Public License * 00018 * along with this program; if not, write to the * 00019 * Free Software Foundation, Inc., * 00020 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * 00021 * * 00022 * $Log: hinge2servo.h,v $ 00023 * Revision 1.1.2.1 2005/12/20 17:53:42 martius 00024 * changed to Joints from joint.h 00025 * new servos for universal and hinge2 00026 * 00027 * * 00028 ***************************************************************************/ 00029 #ifndef __HINGE2SERVO_H 00030 #define __HINGE2SERVO_H 00031 00032 #include "pid.h" 00033 #include "joint.h" 00034 00035 namespace lpzrobots { 00036 00037 /** PID Servo motor for hinge2 joints at axis 1 (steering axis). 00038 */ 00039 class Hinge2Servo { 00040 public: 00041 /** min and max values are understood as travel bounds. 00042 power is the power of the servo 00043 */ 00044 Hinge2Servo(Hinge2Joint* joint, double min, double max, double power); 00045 00046 /** sets the set point of the servo. 00047 Position must be between -1 and 1. It is scaled to fit into min, max 00048 */ 00049 void set(double position); 00050 /** returns the position of the hinge in ranges [-1, 1] (scaled by min, max)*/ 00051 double get(); 00052 00053 private: 00054 PID pid; 00055 double min; 00056 double max; 00057 Hinge2Joint* joint; 00058 }; 00059 00060 } 00061 00062 #endif