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();
|