32011-04-20 22:04:03GonzaloPerezPainaorganización de la wiki22010-06-05 22:53:10GonzaloPerezPaina

ProcessMessage provee de la principal funcionalidad del servidor Player. Diferentes interfaces interactuan unas con otras enviando y recibiendo mensajes a traves de Player. Los diferentes tipos de mensajes pueden verse aquí. Cada interfaz soporta un subconjunto de mensajes. Por ejemplo los tipos de mensajes definidos para la interfaz position2d puden verse aquí. Tipos de mensajes Commands: Se utilizan para darle instrucciones al driver cuando no se requiere una respuesta. La interfaz position2d usa comandos para recibir velocidades para los motores. Requests: Son mensajes desde otros drivers para acceder a datos que no son publicados regularmente o enviar comandos que requieren algún tipo de respuesta. Data: Los mensajes de datos son publicados en cada iteracción del loop Main del driver.

update_odometry(); romaa_comms->get_odometry( pos2d_data.pos.px, pos2d_data.pos.py, pos2d_data.pos.pa ); this->Publish( this->position2d_addr, PLAYER_MSGTYPE_DATA, PLAYER_POSITION2D_DATA_STATE, (void*)&pos2d_data, sizeof( player_position2d_data_t ), NULL ); ]]>utilizando el tipo de dato player_position2d_data_t.

type) if ( Message::MatchMessage( hdr, PLAYER_MSGTYPE_CMD, PLAYER_POSITION2D_CMD_VEL, this->position2d_addr ) ) { memcpy( &position2d_cmd_vel, data, sizeof( player_position2d_cmd_vel_t) ); ]]>set_speed( position2d_cmd_vel.vel.px, position2d_cmd_vel.vel.pa ); return (0); }]]>utilizando el tipo de dato player_position2d_cmd_vel_t.

Con la publicación de la odometría y la actualización de velocidad hacia el robot, se puede controlar la interfaz position2d a través del siguiente programa cliente (mediante el Proxy Position2dProxy) #include ]]>

El programa cliente playerv se bloquea al subscribirce a la interfac position2d y no funciona. Esto se debe a que playerv al ejecutarse envia el mensaje PLAYER_POSITION2D_REQ_GET_GEOM solicitando la geometría del robot para así poder dibujar el cuerpo en pantalla. Se responde a este mensaje de la siguiente manera type) else if ( Message::MatchMessage ( hdr, PLAYER_MSGTYPE_REQ, PLAYER_POSITION2D_REQ_GET_GEOM, this->position2d_addr ) ) { memset( &position2d_geom, 0, sizeof( player_position2d_geom_t ) ); ]]>get_geometry_body_size( position2d_geom.size.sw, position2d_geom.size.sl, position2d_geom.size.sh ); romaa_comms->get_geometry_odometry_center( position2d_geom.pose.px, position2d_geom.pose.py ); ]]>Publish( this->position2d_addr, resp_queue, PLAYER_MSGTYPE_RESP_ACK, PLAYER_POSITION2D_REQ_GET_GEOM, (void*)&position2d_geom, sizeof( player_position2d_geom_t ) ); ]]>utilizando el tipo de dato player_position2d_geom_t.

El cliente playerjoy al iniciar envia el mensaje PLAYER_POSITION2D_REQ_MOTOR_POWER, que se responde de la siguiente manera position2d_addr ) ) { this->Publish( this->position2d_addr, resp_queue, PLAYER_MSGTYPE_RESP_ACK, PLAYER_POSITION2D_REQ_MOTOR_POWER ); return (0); }]]>

Para el caso de resetear la odometria utilizando el método de Position2dProxy::ResetOdometry() del lado del cliente, en el driver del lado del servidor se detecto el error que el tipo de mensaje recibido no es PLAYER_POSITION2D_REQ_RESET_ODOM sino PLAYER_POSITION2D_REQ_SET_ODOM; este error (en el subtipo de mensaje) puede estar del lado del server o del cliente, lo cual no fue determinado. position2d_addr ) ) { // reset position to 0,0,0: no args if ( hdr->size != 0 ) { PLAYER_WARN( "Arg to reset position request is wrong size; ignoring" ); return(-1); } romaa_comms->reset_odometry(); ]]>Publish( this->position2d_addr, resp_queue, PLAYER_MSGTYPE_RESP_ACK, PLAYER_POSITION2D_REQ_RESET_ODOM ); return (0); }]]>

Al llamar el método Position2dProxy::SetOdometry() de lado del cliente, en el servido se obtiene el mensaje correspondiente PLAYER_POSITION2D_REQ_SET_ODOM pero debido al error antes mencionado en ResetOdometry() se procesa el caso de seteo de odometria en (0,0,0) para salvar dicho error. position2d_addr ) ) { if ( hdr->size != sizeof( player_position2d_set_odom_req_t ) ) { PLAYER_WARN("Arg to odometry set requests wrong size; ignoring"); return(-1); } player_position2d_set_odom_req_t* set_odom_req = (player_position2d_set_odom_req_t*)data; ]]>pose.px == 0) && ( set_odom_req->pose.py == 0) && ( set_odom_req->pose.pa == 0) ) { romaa_comms->reset_odometry(); } else { romaa_comms->set_odometry( set_odom_req->pose.px, set_odom_req->pose.py, set_odom_req->pose.pa ); } ]]>Publish( this->position2d_addr, resp_queue, PLAYER_MSGTYPE_RESP_ACK, PLAYER_POSITION2D_REQ_SET_ODOM ); return (0); }]]>