Revision: 6653
http://playerstage.svn.sourceforge.net/playerstage/?rev=6653&view=rev
Author: gbiggs
Date: 2008-06-20 00:04:52 -0700 (Fri, 20 Jun 2008)
Log Message:
-----------
Adding driver wrapper around gearbox flexiport data comms library
Modified Paths:
--------------
code/player/branches/release-2-1-patches/acinclude.m4
code/player/branches/release-2-1-patches/server/drivers/opaque/Makefile.am
code/player/branches/release-2-1-patches/server/libplayerdrivers/driverregistry.cc
Added Paths:
-----------
code/player/branches/release-2-1-patches/server/drivers/opaque/flexiport.cc
Modified: code/player/branches/release-2-1-patches/acinclude.m4
===================================================================
--- code/player/branches/release-2-1-patches/acinclude.m4 2008-06-20
06:59:29 UTC (rev 6652)
+++ code/player/branches/release-2-1-patches/acinclude.m4 2008-06-20
07:04:52 UTC (rev 6653)
@@ -223,6 +223,9 @@
PLAYER_ADD_DRIVER([festival],[yes],[],[],[])
+PLAYER_ADD_DRIVER([flexiport],[yes],[],[],[],[FLEXIPORT],[flexiport >= 0.0.1])
+PLAYER_DRIVER_EXTRA_LIBS="$PLAYER_DRIVER_EXTRA_LIBS $FLEXIPORT_LIBS"
+
PLAYER_ADD_DRIVER([flockofbirds],[yes],[],[],[])
PLAYER_ADD_DRIVER([garcia],[no],
Modified:
code/player/branches/release-2-1-patches/server/drivers/opaque/Makefile.am
===================================================================
--- code/player/branches/release-2-1-patches/server/drivers/opaque/Makefile.am
2008-06-20 06:59:29 UTC (rev 6652)
+++ code/player/branches/release-2-1-patches/server/drivers/opaque/Makefile.am
2008-06-20 07:04:52 UTC (rev 6653)
@@ -1,4 +1,7 @@
-noinst_LTLIBRARIES =
+noinst_LTLIBRARIES =
+if INCLUDE_FLEXIPORT
+noinst_LTLIBRARIES += libflexiport.la
+endif
if INCLUDE_SERIALSTREAM
noinst_LTLIBRARIES += libserialstream.la
endif
@@ -8,8 +11,10 @@
AM_CPPFLAGS = -Wall -I$(top_srcdir)
+libflexiport_la_SOURCES = flexiport.cc
+libflexiport_la_CXXFLAGS = @FLEXIPORT_CFLAGS@
+libflexiport_la_LIBADD = @FLEXIPORT_LIBS@
+
libserialstream_la_SOURCES = serialstream.cc
+
libtcpstream_la_SOURCES = tcpstream.cc
-
-
-
Added:
code/player/branches/release-2-1-patches/server/drivers/opaque/flexiport.cc
===================================================================
--- code/player/branches/release-2-1-patches/server/drivers/opaque/flexiport.cc
(rev 0)
+++ code/player/branches/release-2-1-patches/server/drivers/opaque/flexiport.cc
2008-06-20 07:04:52 UTC (rev 6653)
@@ -0,0 +1,311 @@
+/*
+ * Player - One Hell of a Robot Server
+ * Copyright (C) 2003
+ * Brian Gerkey
+ *
+ *
+ * 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
+ *
+ */
+
+/** @ingroup drivers Drivers */
+/** @{ */
+/*
+ *
+The flexiport driver provides access to a data communications device (such as
a serial port or a TCP
+network port) via the Gearbox flexiport library. Any data received over this
device is published,
+and any writes to this driver are written to the device. It does not process
the data in any way.
+
[EMAIL PROTECTED] Compile-time dependencies
+
+ - flexiport (from Gearbox, see http://gearbox.sourceforge.net)
+
[EMAIL PROTECTED] Provides
+
+ - @ref opaque
+
[EMAIL PROTECTED] Requires
+
+ - none
+
[EMAIL PROTECTED] Configuration requests
+
+ - none
+
[EMAIL PROTECTED] Configuration file options
+
+ - See @ref Properties.
+
[EMAIL PROTECTED] Properties (may also be set in the configuration file)
+
+ - portopts (string)
+ - Default: "type=serial,device=/dev/ttyS0,timeout=1"
+ - Options to create the Flexiport port with.
+
+ - buffer_size (integer)
+ - The size of the buffer to be used when reading. This is the maximum that
can be read in one
+ read command
+ - Default: 4096
+
[EMAIL PROTECTED] Example
+
[EMAIL PROTECTED]
+driver
+(
+ name "sicks3000"
+ provides ["laser:0"]
+ requires ["opaque:0"]
+)
+
+driver
+(
+ name "flexiport"
+ provides ["opaque:0]
+ portopts "type=serial,device=/dev/ttyACM0"
+)
+
[EMAIL PROTECTED]
+
[EMAIL PROTECTED] Geoffrey Biggs
+
+*/
+/** @} */
+
+
+#include <libplayercore/playercore.h>
+#include <flexiport/flexiport.h>
+#include <flexiport/port.h>
+#include <string>
+
+const int DEFAULT_OPAQUE_BUFFER_SIZE = 4096;
+
+////////////////////////////////////////////////////////////////////////////////////////////////////
+// Driver object
+////////////////////////////////////////////////////////////////////////////////////////////////////
+
+class Flexiport : public Driver
+{
+ public:
+ Flexiport (ConfigFile* cf, int section);
+ virtual ~Flexiport (void);
+
+ virtual int Setup (void);
+ virtual int Shutdown (void);
+ virtual int ProcessMessage (QueuePointer &respQueue,
player_msghdr *hdr, void *data);
+
+ protected:
+ IntProperty _bufferSize;
+ StringProperty _portOptions;
+
+ uint8_t *_receiveBuffer;
+
+ flexiport::Port *_port;
+
+ private:
+ virtual int CreatePort (void);
+ virtual void Main();
+ virtual void ReadData();
+};
+
+////////////////////////////////////////////////////////////////////////////////////////////////////
+// Constructor/destructor
+////////////////////////////////////////////////////////////////////////////////////////////////////
+
+Flexiport::Flexiport (ConfigFile* cf, int section)
+ : Driver (cf, section, false, PLAYER_MSGQUEUE_DEFAULT_MAXLEN,
PLAYER_OPAQUE_CODE),
+ _bufferSize ("buffer_size", DEFAULT_OPAQUE_BUFFER_SIZE, 0),
+ _portOptions ("portopts", "type=serial,device=/dev/ttyS0,timeout=1", 0),
+ _port (NULL)
+{
+ RegisterProperty ("buffer_size", &_bufferSize, cf, section);
+ RegisterProperty ("portopts", &_portOptions, cf, section);
+
+ if ((_receiveBuffer = new uint8_t[_bufferSize]) == NULL)
+ {
+ PLAYER_ERROR ("Failed to allocate receive buffer.");
+ }
+}
+
+Flexiport::~Flexiport (void)
+{
+ if (_receiveBuffer != NULL)
+ delete[] _receiveBuffer;
+}
+
+////////////////////////////////////////////////////////////////////////////////////////////////////
+// Driver implementation
+////////////////////////////////////////////////////////////////////////////////////////////////////
+
+int Flexiport::CreatePort (void)
+{
+ try
+ {
+ if (_port != NULL)
+ delete _port;
+ _port = flexiport::CreatePort (_portOptions.GetValue ());
+ _port->Open ();
+ }
+ catch (flexiport::PortException e)
+ {
+ PLAYER_ERROR1 ("flexiport: Failed to create port instance: %s",
e.what ());
+ return 1;
+ }
+
+ return 0;
+}
+
+void Flexiport::Main (void)
+{
+ while (true)
+ {
+ pthread_testcancel ();
+ ProcessMessages ();
+ ReadData ();
+ usleep (100000);
+ }
+}
+
+int Flexiport::ProcessMessage (QueuePointer &respQueue, player_msghdr *hdr,
void *data)
+{
+ // Check for capability requests
+ HANDLE_CAPABILITY_REQUEST (device_addr, respQueue, hdr, data,
+ PLAYER_MSGTYPE_REQ, PLAYER_CAPABILTIES_REQ);
+
+ // Property handlers that need to be done manually due to calling into
the urg_nz library.
+ if (Message::MatchMessage (hdr, PLAYER_MSGTYPE_REQ,
PLAYER_SET_INTPROP_REQ, device_addr))
+ {
+ player_intprop_req_t *req =
reinterpret_cast<player_intprop_req_t*> (data);
+ // Change in the baud rate
+ if (strncmp (req->key, "buffer_size", 11) == 0)
+ {
+ // Reallocate the buffer
+ uint8_t *newBuffer;
+ if ((newBuffer = new uint8_t[req->value]) == NULL)
+ {
+ PLAYER_ERROR ("flexiport: Failed to reallocate
receive buffer.");
+ Publish (device_addr, respQueue,
PLAYER_MSGTYPE_RESP_NACK, PLAYER_SET_INTPROP_REQ,
+ NULL, 0, NULL);
+ return 0;
+ }
+
+ if (_receiveBuffer != NULL)
+ delete[] _receiveBuffer;
+ _receiveBuffer = newBuffer;
+ _bufferSize.SetValueFromMessage (data);
+
+ Publish (device_addr, respQueue,
PLAYER_MSGTYPE_RESP_ACK, PLAYER_SET_INTPROP_REQ, NULL,
+ 0, NULL);
+ return 0;
+ }
+ }
+ else if (Message::MatchMessage (hdr, PLAYER_MSGTYPE_REQ,
PLAYER_SET_STRPROP_REQ, device_addr))
+ {
+ player_strprop_req_t *req =
reinterpret_cast<player_strprop_req_t*> (data);
+ // Change in the port options
+ if (strncmp (req->key, "portopts", 8) == 0)
+ {
+ _portOptions.SetValueFromMessage (data);
+ if (CreatePort () != 0)
+ {
+ PLAYER_ERROR ("flexiport: Failed to create new
port with new options.");
+ Publish (device_addr, respQueue,
PLAYER_MSGTYPE_RESP_NACK, PLAYER_SET_STRPROP_REQ,
+ NULL, 0, NULL);
+ return 0;
+ }
+ Publish (device_addr, respQueue,
PLAYER_MSGTYPE_RESP_ACK, PLAYER_SET_STRPROP_REQ, NULL,
+ 0, NULL);
+ return 0;
+ }
+ }
+
+ // Standard opaque messages
+ else if (Message::MatchMessage (hdr, PLAYER_MSGTYPE_CMD,
PLAYER_OPAQUE_CMD_DATA, device_addr))
+ {
+ player_opaque_data_t *recv =
reinterpret_cast<player_opaque_data_t *> (data);
+ if (recv->data_count <= 0)
+ return 0;
+
+ _port->Flush ();
+
+ try
+ {
+ size_t written;
+ if ((written = _port->Write (recv->data,
recv->data_count)) < recv->data_count)
+ {
+ PLAYER_ERROR2 ("flexiport: Wrote less data than
given: %d < %d", written,
+
recv->data_count);
+ }
+ }
+ catch (flexiport::PortException e)
+ {
+ PLAYER_ERROR1 ("flexiport: Error writing to port: %s",
e.what ());
+ }
+
+ return 0;
+ }
+
+ return -1;
+}
+
+void Flexiport::ReadData (void)
+{
+ size_t read = _port->Read (_receiveBuffer, _bufferSize);
+
+ if (read <= 0)
+ {
+ // Timed out/no data available
+ return;
+ }
+
+ player_opaque_data_t data;
+ data.data_count = read;
+ data.data = _receiveBuffer;
+ Publish (device_addr, PLAYER_MSGTYPE_DATA, PLAYER_OPAQUE_DATA_STATE,
+ reinterpret_cast<void*> (&data));
+}
+
+int Flexiport::Setup (void)
+{
+ if (CreatePort () != 0)
+ return 1;
+
+ StartThread();
+
+ return 0;
+}
+
+int Flexiport::Shutdown (void)
+{
+ StopThread();
+
+ delete _port;
+ _port = NULL;
+
+ return 0;
+}
+
+////////////////////////////////////////////////////////////////////////////////////////////////////
+// Driver management functions
+////////////////////////////////////////////////////////////////////////////////////////////////////
+
+Driver* FlexiportInit (ConfigFile* cf, int section)
+{
+ return reinterpret_cast <Driver*> (new Flexiport (cf, section));
+}
+
+void flexiport_Register (DriverTable* table)
+{
+ table->AddDriver ("flexiport", FlexiportInit);
+}
Modified:
code/player/branches/release-2-1-patches/server/libplayerdrivers/driverregistry.cc
===================================================================
---
code/player/branches/release-2-1-patches/server/libplayerdrivers/driverregistry.cc
2008-06-20 06:59:29 UTC (rev 6652)
+++
code/player/branches/release-2-1-patches/server/libplayerdrivers/driverregistry.cc
2008-06-20 07:04:52 UTC (rev 6653)
@@ -510,6 +510,10 @@
void urg_nz_Register(DriverTable* table);
#endif
+#ifdef INCLUDE_FLEXIPORT
+void flexiport_Register(DriverTable* table);
+#endif
+
/*
* this function will be called at startup. all available devices should
* be added to the driverTable here. they will be instantiated later as
@@ -979,4 +983,8 @@
#ifdef INCLUDE_URG_NZ
urg_nz_Register(driverTable);
#endif
+
+#ifdef INCLUDE_FLEXIPORT
+ flexiport_Register(driverTable);
+#endif
}
This was sent by the SourceForge.net collaborative development platform, the
world's largest Open Source development site.
-------------------------------------------------------------------------
Check out the new SourceForge.net Marketplace.
It's the best place to buy or sell services for
just about anything Open Source.
http://sourceforge.net/services/buy/index.php
_______________________________________________
Playerstage-commit mailing list
[email protected]
https://lists.sourceforge.net/lists/listinfo/playerstage-commit
