Remove code for shell command utility
							parent
							
								
									b415b9d591
								
							
						
					
					
						commit
						53b127232c
					
				| @ -1,92 +0,0 @@ | ||||
| #include "robomaster.h" | ||||
| 
 | ||||
| #include <stdio.h> | ||||
| #include <stdlib.h> | ||||
| #include <unistd.h> | ||||
| 
 | ||||
| int main(int argc, char* argv[]) | ||||
| { | ||||
|     Client client = client_new(); | ||||
|     client_connect(client); | ||||
| 
 | ||||
|     union Message msg; | ||||
|     poll_message(client, &msg); | ||||
|     if(msg.header.cmdid != SET_SDK_CONNECTION_CMDID || msg.resp.sdkconn.retcode) { | ||||
|         fprintf(stderr, "Could not set SDK connection\n"); | ||||
|         return 1; | ||||
|     } | ||||
| 
 | ||||
|     set_sdk_mode(client, true); | ||||
|     poll_message(client, &msg); | ||||
|     if(msg.header.cmdid != SET_SDK_MODE_CMDID || msg.resp.sdkmode.retcode) { | ||||
|         fprintf(stderr, "Could not set SDK mode\n"); | ||||
|         return 1; | ||||
|     } | ||||
| 
 | ||||
|     subnode_reset(client); | ||||
|     poll_message(client, &msg); | ||||
|     if(msg.header.cmdid != SUBNODE_RESET_CMDID || msg.resp.subnodereset.retcode) { | ||||
|         fprintf(stderr, "Could not reset subnode subscription\n"); | ||||
|         return 1; | ||||
|     } | ||||
| 
 | ||||
|     subscribe_add_node(client); | ||||
|     poll_message(client, &msg); | ||||
|     if(msg.header.cmdid != SUBSCRIBE_ADD_NODE_CMDID || (msg.resp.subnodeadd.retcode && msg.resp.subnodeadd.retcode != 0x50)) { | ||||
|         fprintf(stderr, "Could not subscribe node\n"); | ||||
|         return 1; | ||||
|     } | ||||
| 
 | ||||
|     set_robot_mode(client, MOVEMENTMODE_FREE); | ||||
|     poll_message(client, &msg); | ||||
|     if(msg.header.cmdid != SET_ROBOT_MODE_CMDID || msg.resp.mvmode.retcode) { | ||||
|         fprintf(stderr, "Could not set move mode\n"); | ||||
|         return 1; | ||||
|     } | ||||
| 
 | ||||
|     sdk_heartbeat(client); | ||||
|     //poll_message(client, &msg);
 | ||||
|     //if(msg.header.cmdid != SDK_HEARTBEAT_CMDID || msg.resp.heartbeat.retcode) {
 | ||||
|     //    fprintf(stderr, "Did not receive heartbeat\n");
 | ||||
|     //    return 1;
 | ||||
|     //}
 | ||||
| 
 | ||||
|     int c; | ||||
|     while((c = getopt(argc, argv, "hl:::s:::")) != -1) { | ||||
|         switch(c) { | ||||
|             case 'l': | ||||
|                 set_system_led ( | ||||
|                 		client, | ||||
|                 		strtol(argv[optind + 0], NULL, 0), | ||||
|                 		strtol(argv[optind + 1], NULL, 0), | ||||
|                 		strtol(argv[optind + 2], NULL, 0), | ||||
|                 		LEDCOMP_ALL, | ||||
|                 		0xFFFF, | ||||
|                 		LEDEFFECT_ON, | ||||
|                 		100, | ||||
|                 		100 ); | ||||
|                 poll_message(client, &msg); | ||||
|                 if(msg.header.cmdid != SET_SYSTEM_LED_CMDID || msg.resp.led.retcode) { | ||||
|                     fprintf(stderr, "Could not set LED color\n"); | ||||
|                     return 1; | ||||
|                 } | ||||
| 		break; | ||||
|             case 's': | ||||
|                 chassis_speed_mode ( | ||||
|                 		client, | ||||
|                 		atof(argv[optind + 0]), | ||||
|                 		atof(argv[optind + 1]), | ||||
|                 		atof(argv[optind + 2]) ); | ||||
| 		break; | ||||
|             case '?': | ||||
|             default: | ||||
| 		fprintf(stderr, "Unknown argument %c\n", optopt); | ||||
|             case 'h': | ||||
| 		printf("Usage: [-h] [-l r g b] [-w w1 w2 w3 w4]"); | ||||
| 		return 0; | ||||
| 	} | ||||
|     } | ||||
| 
 | ||||
|     return 0; | ||||
| } | ||||
| 
 | ||||
					Loading…
					
					
				
		Reference in New Issue