//Ejemplo que pide los datos de la placa y pueden ser leidos desde el buffer void exampleInfo(SBGC_Parser sbgc_parser) { sbgc_parser.send_command(SBGC_CMD_REALTIME_DATA, NULL, 0, 0); //printf("Resultado envio -> %d (0 correcto)\n", sbgc_parser.send_command(SBGC_CMD_REALTIME_DATA, NULL, 0, 0)); if (sbgc_parser.read_cmd()) { printf("\nParseado correctamente"); } //printf("\nNumero de errores %d", sbgc_parser.in_cmd.data[8]); //printf("\nBoard Info -> %d\nversion %db%d ", sbgc_parser.in_cmd.data[0], sbgc_parser.in_cmd.data[1], sbgc_parser.in_cmd.data[2]); SBGC_cmd_realtime_data_t datos; if(SBGC_cmd_realtime_data_unpack(datos, sbgc_parser.in_cmd) == PARSER_ERROR_WRONG_DATA_SIZE) { printf("ERROOOOOOOOOOOR EN DATOS"); } Sleep(20); }
//Ejemplo que pide los datos de la placa y pueden ser leidos desde el buffer void exampleInfo(SBGC_Parser sbgc_parser) { printf("Resultado envio -> %d (0 correcto)\n" , sbgc_parser.send_command(SBGC_CMD_BOARD_INFO,NULL, 0, 0)); Sleep(20); }
void exampleAngles(SBGC_Parser sbgc_parser) { sbgc_parser.send_command(SBGC_CMD_GET_ANGLES, NULL, 0, 0); Sleep(1000); sbgc_parser.read_cmd(); Sleep(20); }
//Apagar los motores void exampleMotorsOFF(SBGC_Parser sbgc_parser) { printf("Resultado envio -> %d (0 correcto)\n", sbgc_parser.send_command(SBGC_CMD_MOTORS_OFF, NULL, 0, 0)); sbgc_parser.read_cmd(); Sleep(20); }