您好,我正在研究带有单个 IR 传感器的线跟随机器人。
我已经获得了模拟客户端+硬件。我现在正在尝试模拟部分,我必须沿着有效路径移动机器人,直到在迷宫中找到一个标记。然后停下来给出坐标 x, y 像这样:“token found on x , y”。服务器应用程序给出的坐标基于全局坐标系(例如东、西...),您的机器人有一个局部坐标系(例如向左、向右、向前...)。在开始时选择机器人的方向并在屏幕上显示实际坐标。在每个动作发送到服务器之前,应用程序在屏幕上给出机器人方向的必要修正(“向左”、“向前”、“向右”、“转身”),然后将坐标发送到服务器. 例子:
有两种方法可以在本地或远程服务器上模拟程序,在本地机器上我可以看到迷宫,但在远程服务器上总是给我未知的迷宫。
我有两个C文件
roboproxy.c
#include <stdarg.h>
#include "../h/RobotProxy.h"
/// initialized with ROBOT_FAIL
int currentIntersection = ROBOT_FAIL;
#if !defined(vasprintf)
static int vasprintf(char **s, const char *format, va_list ap) {
/* Guess we need no more than 100 bytes. */
int n, size = 100;
va_list save_ap;
if ((*s = (char*) malloc(size)) == NULL)
return -1;
while (1) {
/* work on a copy of the va_list because of a bug
in the vsnprintf implementation in x86_64 libc
*/
#ifdef __va_copy
__va_copy(save_ap, ap);
#else
save_ap = ap;
#endif
/* Try to print in the allocated space. */
#ifdef _vsnprintf
n = _vsnprintf(*s, size, format, save_ap);
#else
n = vsnprintf(*s, size, format, save_ap);
#endif
va_end(save_ap);
/* If that worked, return the string. */
if (n > -1 && n < size) {
return n;
}
/* Else try again with more space. */
if (n > -1) { /* glibc 2.1 */
size = n + 1; /* precisely what is needed */
} else { /* glibc 2.0 */
size *= 2; /* twice the old size */
}
if ((*s = (char*) realloc(*s, size)) == NULL) {
return -1;
}
}
}
#endif
#if !defined(asprintf)
static int asprintf(char **s, const char *format, ...) {
va_list vals;
int result;
va_start(vals, format);
result = vasprintf(s, format, vals);
va_end(vals);
return result;
}
#endif
/// Set the robot to the specified position
/// @ returns ROBOT_SUCCESS, ROBOT_FAIL or ROBOT_TOKENFOUND
int Robot_Move(int x, int y) {
char* buffer;
asprintf(&buffer, "{\"x\":%d,\"y\":%d}", x, y);
char* query = url_encode(buffer);
free(buffer);
char* response = sendAndRecieve(concat(URL, query));
if (response == NULL) {
puts("Connection to server failed!");
return ROBOT_FAIL;
}
if (contains(response, "\"code\":1")) {
puts("Connection declined!");
return ROBOT_FAIL;
}
if (contains(response, "\"code\":2")) {
puts("Connection blocked!");
return ROBOT_FAIL;
}
if (contains(response, "\"code\":3")) {
printf("Invalid position! (x=%d, y=%d)\n", x, y);
return ROBOT_FAIL;
}
int foundIntersection = 0;
bool token = false;
if (contains(response, "\"north\":true"))
foundIntersection |= D_N;
if (contains(response, "\"east\":true"))
foundIntersection |= D_E;
if (contains(response, "\"south\":true"))
foundIntersection |= D_S;
if (contains(response, "\"west\":true"))
foundIntersection |= D_W;
if (contains(response, "\"token\":true"))
token = true;
free(query);
currentIntersection = foundIntersection;
if (token)
return ROBOT_TOKENFOUND;
return ROBOT_SUCCESS;
}
/// Get the intersections of the current node that the robot is at
/// @ returns always the intersection at position x=0,y=0 if Robot_Move was not called first
int Robot_GetIntersections() {
if (currentIntersection == ROBOT_FAIL)
Robot_Move(0, 0);
return currentIntersection;
}
机器人客户端sim.C
#include "../h/Configuration.h"
int main(void) {
printf("Token: %d\n", Robot_Move(1, 0));
printf("Intersection: %d\n", Robot_GetIntersections());
return EXIT_SUCCESS;
}
当我在控制台中运行程序时,它告诉我 Token 是 1,然后在找到任何令牌后它将变为 2。
所以在 roboclientsim.c 我添加了“
If (Robot_Move()==2) //as Robot_move is returning the %d value for Token
printf("another token found ");
"
但是我的编译器给出的问题是robot_move的争论很少,
任何人都可以帮我解决这个问题吗?