[Robotflow-cvs] RobotFlow/Pioneer2/src Pioneer2PacketManager.cc,1.15,1.16

[Mathieu L. <ml...@us...>]

Update of /cvsroot/robotflow/RobotFlow/Pioneer2/src
In directory sc8-pr-cvs1.sourceforge.net:/tmp/cvs-serv29209/src

Modified Files:
	Pioneer2PacketManager.cc 
Log Message:
Fix bug in function "send_string_command(...)". First byte of string is
the length of string.


Index: Pioneer2PacketManager.cc
===================================================================
RCS file: /cvsroot/robotflow/RobotFlow/Pioneer2/src/Pioneer2PacketManager.cc,v
retrieving revision 1.15
retrieving revision 1.16
diff -C2 -d -r1.15 -r1.16
*** Pioneer2PacketManager.cc	16 Aug 2004 19:20:03 -0000	1.15
--- Pioneer2PacketManager.cc	16 Aug 2004 20:45:06 -0000	1.16
***************
*** 1171,1175 ****
  void Pioneer2PacketManager::send_string_command(unsigned char command, const string& data) {
  
!   unsigned char to_send[data.size() + 2];
  
    if (m_psos_state == NO_SYNC && m_file_descriptor > 0 ) {
--- 1171,1175 ----
  void Pioneer2PacketManager::send_string_command(unsigned char command, const string& data) {
  
!   unsigned char to_send[data.size() + 3];
  
    if (m_psos_state == NO_SYNC && m_file_descriptor > 0 ) {
***************
*** 1191,1196 ****
    to_send[0] = command;
    to_send[1] = 0x2b;
!   memcpy(&to_send[2],data.c_str(),data.size());
!   packet.create_packet(to_send,data.size() + 2);
    m_send_list.push_back(packet);
    unlock_send_thread();
--- 1191,1197 ----
    to_send[0] = command;
    to_send[1] = 0x2b;
!   to_send[2] = data.size();
!   memcpy(&to_send[3],data.c_str(),data.size());
!   packet.create_packet(to_send,data.size() + 3);
    m_send_list.push_back(packet);
    unlock_send_thread();