/usr/include/Aria/ArLMS1XX.h is in libaria-dev 2.8.0+repack-1.2ubuntu1.
This file is owned by root:root, with mode 0o644.
The actual contents of the file can be viewed below.
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 | /*
Adept MobileRobots Robotics Interface for Applications (ARIA)
Copyright (C) 2004, 2005 ActivMedia Robotics LLC
Copyright (C) 2006, 2007, 2008, 2009, 2010 MobileRobots Inc.
Copyright (C) 2011, 2012, 2013 Adept Technology
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
If you wish to redistribute ARIA under different terms, contact
Adept MobileRobots for information about a commercial version of ARIA at
robots@mobilerobots.com or
Adept MobileRobots, 10 Columbia Drive, Amherst, NH 03031; +1-603-881-7960
*/
#ifndef ARLMS1XX_H
#define ARLMS1XX_H
#include "ariaTypedefs.h"
#include "ArRobotPacket.h"
#include "ArLaser.h"
#include "ArFunctor.h"
/** @internal */
class ArLMS1XXPacket : public ArBasePacket
{
public:
/// Constructor
AREXPORT ArLMS1XXPacket();
/// Destructor
AREXPORT virtual ~ArLMS1XXPacket();
/// Gets the command type
AREXPORT const char *getCommandType(void);
/// Gets the command name
AREXPORT const char *getCommandName(void);
// only call finalizePacket before a send
AREXPORT virtual void finalizePacket(void);
AREXPORT virtual void resetRead(void);
/// Gets the time the packet was received at
AREXPORT ArTime getTimeReceived(void);
/// Sets the time the packet was received at
AREXPORT void setTimeReceived(ArTime timeReceived);
AREXPORT virtual void duplicatePacket(ArLMS1XXPacket *packet);
AREXPORT virtual void empty(void);
AREXPORT virtual void byteToBuf(ArTypes::Byte val);
AREXPORT virtual void byte2ToBuf(ArTypes::Byte2 val);
AREXPORT virtual void byte4ToBuf(ArTypes::Byte4 val);
AREXPORT virtual void uByteToBuf(ArTypes::UByte val);
AREXPORT virtual void uByte2ToBuf(ArTypes::UByte2 val);
AREXPORT virtual void uByte4ToBuf(ArTypes::UByte4 val);
AREXPORT virtual void strToBuf(const char *str);
AREXPORT virtual ArTypes::Byte bufToByte(void);
AREXPORT virtual ArTypes::Byte2 bufToByte2(void);
AREXPORT virtual ArTypes::Byte4 bufToByte4(void);
AREXPORT virtual ArTypes::UByte bufToUByte(void);
AREXPORT virtual ArTypes::UByte2 bufToUByte2(void);
AREXPORT virtual ArTypes::UByte4 bufToUByte4(void);
AREXPORT virtual void bufToStr(char *buf, int len);
// adds a raw char to the buf
AREXPORT virtual void rawCharToBuf(unsigned char c);
protected:
int deascii(char c);
ArTime myTimeReceived;
bool myFirstAdd;
char myCommandType[1024];
char myCommandName[1024];
};
/// Given a device connection it receives packets from the sick through it
/// @internal
class ArLMS1XXPacketReceiver
{
public:
/// Constructor with assignment of a device connection
AREXPORT ArLMS1XXPacketReceiver();
/// Destructor
AREXPORT virtual ~ArLMS1XXPacketReceiver();
/// Receives a packet from the robot if there is one available
AREXPORT ArLMS1XXPacket *receivePacket(unsigned int msWait = 0,
bool shortcut = false,
bool ignoreRemainders = false);
AREXPORT ArLMS1XXPacket *receiveTiMPacket(unsigned int msWait = 0,
bool shortcut = false,
bool ignoreRemainders = false);
/// Sets the device this instance receives packets from
AREXPORT void setDeviceConnection(ArDeviceConnection *conn);
/// Gets the device this instance receives packets from
AREXPORT ArDeviceConnection *getDeviceConnection(void);
// PS - added to pass info to this class
AREXPORT void setmyInfoLogLevel(ArLog::LogLevel infoLogLevel)
{ myInfoLogLevel = infoLogLevel; }
AREXPORT void setLaserModel(int laserModel)
{ myLaserModel = laserModel; }
AREXPORT void setmyName(const char *name )
{ strcpy(myName, name); }
AREXPORT void setReadTimeout(int timeout )
{ myReadTimeout = timeout; }
protected:
ArDeviceConnection *myConn;
ArLMS1XXPacket myPacket;
enum State
{
STARTING, ///< Looking for beginning
DATA, ///< Read the data in a big whack
REMAINDER ///< Have extra data from reading in data
};
State myState;
char myName[1024];
unsigned int myNameLength;
char myReadBuf[100000];
int myReadCount;
int myReadTimeout;
int myLaserModel;
ArLog::LogLevel myInfoLogLevel;
};
/**
@since Aria 2.7.2
@see ArLaserConnector
Use ArLaserConnector to connect to a laser, determining type based on robot and program configuration parameters.
This is the ArLaser implementation for SICK LMS1xx, LMS5xx, and TiM3xx lasers. To use these lasers with ArLaserConnector, specify
the appropriate type in program configuration (lms1xx, lms6xx, or tim3xx).
*/
class ArLMS1XX : public ArLaser
{
public:
enum LaserModel
{
LMS1XX,
LMS5XX,
TiM3XX
};
/// Constructor
AREXPORT ArLMS1XX(int laserNumber,
const char *name,
LaserModel laserModel);
/// Destructor
AREXPORT ~ArLMS1XX();
AREXPORT virtual bool blockingConnect(void);
// specific init routine per laser
AREXPORT virtual bool lms5xxConnect(void);
AREXPORT virtual bool lms1xxConnect(void);
AREXPORT virtual bool tim3xxConnect(void);
AREXPORT virtual bool asyncConnect(void);
AREXPORT virtual bool disconnect(void);
AREXPORT virtual bool isConnected(void) { return myIsConnected; }
AREXPORT virtual bool isTryingToConnect(void)
{
if (myStartConnect)
return true;
else if (myTryingToConnect)
return true;
else
return false;
}
/// Logs the information about the sensor
AREXPORT void log(void);
protected:
AREXPORT virtual void laserSetName(const char *name);
AREXPORT virtual void * runThread(void *arg);
AREXPORT virtual void setRobot(ArRobot *robot);
AREXPORT ArLMS1XXPacket *sendAndRecv(
ArTime timeout, ArLMS1XXPacket *sendPacket, const char *recvName);
void sensorInterp(void);
void failedToConnect(void);
void clear(void);
bool validateCheckSum(ArLMS1XXPacket *packet);
LaserModel myLaserModel;
//bool myIsLMS5XX;
bool myIsConnected;
bool myTryingToConnect;
bool myStartConnect;
int myScanFreq;
int myVersionNumber;
int myDeviceNumber;
int mySerialNumber;
int myDeviceStatus1;
int myDeviceStatus2;
int myMessageCounter;
int myScanCounter;
int myPowerUpDuration;
int myTransmissionDuration;
int myInputStatus1;
int myInputStatus2;
int myOutputStatus1;
int myOutputStatus2;
int myReserved;
int myScanningFreq;
int myMeasurementFreq;
int myNumberEncoders;
int myNumChans16Bit;
int myNumChans8Bit;
int myFirstReadings;
int myYear;
int myMonth;
int myMonthDay;
int myHour;
int myMinute;
int mySecond;
int myUSec;
ArLog::LogLevel myLogLevel;
ArLMS1XXPacketReceiver myReceiver;
ArMutex myPacketsMutex;
ArMutex myDataMutex;
std::list<ArLMS1XXPacket *> myPackets;
ArFunctorC<ArLMS1XX> mySensorInterpTask;
ArRetFunctorC<bool, ArLMS1XX> myAriaExitCB;
};
#endif
|