一起来开发一个磁条机器人（六）

一起来开发一个磁条机器人（六） MOmo 2023-04-23 09:46:58 896
机器人学

描述

以下两篇文章将是这一系列最后的两篇，将对全部的代码进行剖析

开发的时间并不多，有些写的并不是最优的实现，请多指教

代码

control.h、control.c
这两个文件是主控的核心代码
在control.h头文件中我们定义了一些常量和结构体
在control.c中做了两件事：解析命令buffer，根据磁信息调整左右电机转速

control.h

// copyright: @fuxi_robot corporation
#ifndef __CONTROL_H__
#define __CONTROL_H__

#include "main.h"
#include <stdio.h>
#include <string.h>

#define OBSTACLE_DISTANCE_MIN 40
#define OBSTACLE_SMOOTH_NUM 10

#define MOTOR_SPEED_MAX 5500
#define MOTOR_SPEED_MIN 1000
#define MOTOR_SPEED_INITIAL 1500
#define MOTOR_SPEED_DELTA 400

// card_id function
#define CARD_ID_STOPPED 90
#define CARD_ID_CHARGE 91
#define CARD_ID_SPEED_LOW 92
#define CARD_ID_SPEED_MIDDLE 93
#define CARD_ID_SPEED_HIGH 94
#define CARD_ID_SLEEP_15 95
#define CARD_ID_SLEEP_30 96
#define CARD_ID_SLEEP_60 97

#define MAGNETIC_BUFFER_LEN 8

#define abs(x) ((x)>0?(x):-(x))
// robot status
enum Robot_status
{
    READY = 0,
    BLOCK,
    RUNNING,
    DERAILED
};

// command people
enum Command_kind
{
    RUN = 0,
    STOP,
    SET_SPEED,
    SET_TARGET,
    CHARGE,
    WALK_FORWARD,
    WALK_REAR,
    WALK_LEFT,
    WALK_RIGHT,
    QUERY_STATUS,
    QUERY_SPEED,
    QUERY_TARGET,
    QUERY_ALL,
    COMMAND_ERROR,
};

enum Motor_state
{
    MOTOR_ENABLE = 0,
    MOTOR_DISABLE,
};

struct Command
{
    enum Command_kind m_command_kind;
    int m_command_value;
};

struct Robot
{
    enum Robot_status m_robot_status;
    enum Robot_status m_robot_status_last;

    int m_is_derailed;
    int m_change_derailed_first;
    int m_is_blocked;
    int m_change_block_first;

    int m_speed;
    int m_target;
    int m_motor_left_value;
    int m_motor_right_value;
    int m_direction;

    int m_magnetic_value;
    int m_magnetic_status_0_1[MAGNETIC_BUFFER_LEN];

    int m_obstacle_left_distance;
    int m_obstacle_right_distance;
    int m_obstacle_left_distance_memory[OBSTACLE_SMOOTH_NUM];
    int m_obstacle_right_distance_memory[OBSTACLE_SMOOTH_NUM];
    int m_obstacle_left_distance_sum;
    int m_obstacle_right_distance_sum;
};

int run(struct Robot robot, struct Command command);

int query(struct Robot robot, struct Command command, enum Motor_state motor, int query_ind);
struct Command translate_infor_2_command(char info_buffer[256]);
struct Robot translate_magnetic_2_motor(struct Robot robot, int magnetic_value);

#endif
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21
  • 22
  • 23
  • 24
  • 25
  • 26
  • 27
  • 28
  • 29
  • 30
  • 31
  • 32
  • 33
  • 34
  • 35
  • 36
  • 37
  • 38
  • 39
  • 40
  • 41
  • 42
  • 43
  • 44
  • 45
  • 46
  • 47
  • 48
  • 49
  • 50
  • 51
  • 52
  • 53
  • 54
  • 55
  • 56
  • 57
  • 58
  • 59
  • 60
  • 61
  • 62
  • 63
  • 64
  • 65
  • 66
  • 67
  • 68
  • 69
  • 70
  • 71
  • 72
  • 73
  • 74
  • 75
  • 76
  • 77
  • 78
  • 79
  • 80
  • 81
  • 82
  • 83
  • 84
  • 85
  • 86
  • 87
  • 88
  • 89
  • 90
  • 91
  • 92
  • 93
  • 94
  • 95
  • 96
  • 97
  • 98
  • 99
  • 100
  • 101
  • 102
  • 103
<

control.c

#include "control.h"

int query(struct Robot robot, struct Command command, enum Motor_state motor, int query_ind)
{
    switch (query_ind)
    {
        // query state
        case 0:
            printf("< answer >< OK >[ query ][ all ]\n");
            if (robot.m_robot_status == 0)
            {
                printf("----- robot   - state: READY");
            }
            else if(robot.m_robot_status == 1)
            {
                printf("----- robot   - state: BLOCK");
            }
            else if (robot.m_robot_status == 2)
            {
                printf("----- robot   - state: RUNNING");
            }
            else if (robot.m_robot_status == 3)
            {
                printf("----- robot   - state: DERAILED");
            }
            printf(", speed: %d , target: %d , left: %d , right: %d , direction:%d\n",  
            robot.m_speed, 
            robot.m_target,
            robot.m_motor_left_value,
            robot.m_motor_right_value,
            robot.m_direction);
        printf("----- robot   - magnetic value: %d , status: %d %d %d% d %d %d %d %d\n"
            ,robot.m_magnetic_value
            ,robot.m_magnetic_status_0_1[0]
            ,robot.m_magnetic_status_0_1[1]
            ,robot.m_magnetic_status_0_1[2]
            ,robot.m_magnetic_status_0_1[3]
            ,robot.m_magnetic_status_0_1[4]
            ,robot.m_magnetic_status_0_1[5]
            ,robot.m_magnetic_status_0_1[6]
            ,robot.m_magnetic_status_0_1[7]);
        printf("----- derailed and blocked  - derailed: %d , blocked: %d\n",  robot.m_is_derailed, robot.m_is_blocked);
        printf("----- obstacle   - left: %d , right: %d\n",  robot.m_obstacle_left_distance, robot.m_obstacle_right_distance);
            printf("----- motor   - status: %d\n", motor);
            printf("----- command - kind: %d , value: %d\n", command.m_command_kind, command.m_command_value);
            printf("----- last status: %d \n", robot.m_robot_status_last);
            break;
        case 1:
            switch (robot.m_robot_status)
            {
                case READY:
                    printf("< answer >< OK >[ query ][ state ]: READY\n");
                    break;
                case BLOCK:
                    printf("< answer >< OK >[ query ][ state ]: BLOCKED\n");
                    break;
                case RUNNING:
                    printf("< answer >< OK >[ query ][ state ]: RUNNING\n");
                    break;
                case DERAILED:
                    printf("< answer >< OK >[ query ][ state ]: DERAILED\n");
                    break;
            }
            break;
        // query speed
        case 2:
            printf("< answer >< OK >[ query ][ speed ]: %d\n", robot.m_speed);
            break;
        // query target
        case 3:
            if (robot.m_target != -1)
            {
                printf("< answer >< OK >[ query ][ target ]: %d\n", robot.m_target);
            }
            else
            {
                printf("< answer >< OK >[ query ][ target ]: no target!\n");
            }
            break; 
    }
    return 0;
}

int char_2_int(char* source)
{
    int number_length = strlen(source);
    int number_sum = 0;
    int number_positive = 1;
    int k = 0;

    if (source[0] -'-' == 0)
    {
        number_positive = -1;
        k = 1;
    }
    for(int i = k; i < number_length; i++)
    {
        number_sum = number_sum * 10 + (source[i] -'0');
    }
    number_sum = number_sum * number_positive;

//    printf("understand 111\n");
//    for (int i = 0 ; i < strlen(source); i++)
//    {
//        printf("%c", source[i]);
//    }
//    printf("\n");
//    
    return number_sum;
}

struct Command translate_infor_2_command(char info_buffer[256])
{
    struct Command command_output;

    int buffer_size = 1;
    int buffer_length = 0;

    for (int i = 0 ; i < 256; i ++)
    {
        if (info_buffer[i] == ' ')    
        {
            buffer_size = 2;
        }
        if (info_buffer[i] == ';')
        {
            buffer_length = i+1;
            break;
        }
    }

//    printf("info_buffer 111\n");
//    for (int i = 0 ; i < strlen(info_buffer); i++)
//    {
//        printf("%c", info_buffer[i]);
//    }
//    printf("\n");

    // move out ';'
    char* a = info_buffer;
    char TagName[256];
    memset(TagName,0x00,sizeof(TagName)); 
    strncpy(TagName, a, buffer_length-1);
    char* aa = TagName;

//    printf("after 111\n");
//    for (int i = 0 ; i < strlen(aa); i++)
//    {
//        printf("%c", aa[i]);
//    }
//    printf("\n");

    char seg[] = " ";
    char *command_buffer = strtok(aa, seg);
    if(command_buffer!=NULL)
    {
        char *second_str = strtok(NULL, seg);

//        printf("second 111\n");
//        for (int i = 0 ; i < strlen(second_str); i++)
//        {
//            printf("%c", second_str[i]);
//        }
//        printf("\n");

        if(second_str!=NULL)
        {
            if(strcmp(command_buffer, "speed") == 0)
            {
                int speed = char_2_int(second_str);

                if (abs(speed) > abs(MOTOR_SPEED_MAX) || abs(speed) < abs(MOTOR_SPEED_MIN))
                {
                    printf("< command >< ERROR >: Speed is too high or too slow, error!\n");
                    command_output.m_command_kind = COMMAND_ERROR;
                    command_output.m_command_value = -1;
                }
                else
                {
                    printf("< command >[ set ][ speed ]: %d\n", speed);
                    command_output.m_command_kind = SET_SPEED;
                    command_output.m_command_value = speed;
                }    
            }
            else if(strcmp(command_buffer, "to") == 0)
            {
                int target = char_2_int(second_str);
                printf("<command>[ set ][ target ]: %d\n", target);

                command_output.m_command_kind = SET_TARGET;
                command_output.m_command_value = target;
            }
            else if(strcmp(command_buffer, "query") == 0)
            {
                if (strcmp(second_str, "state") == 0)
                {
                    printf("< command >[ query ][ state ]\n");
                    command_output.m_command_kind = QUERY_STATUS;
                    command_output.m_command_value = -1;
                }
                else if (strcmp(second_str, "speed") == 0)
                {
                    printf("< command >[ query ][ speed ]\n");
                    command_output.m_command_kind = QUERY_SPEED;
                    command_output.m_command_value = -1;
                }
                else if (strcmp(second_str, "target") == 0)
                {
                    printf("< command >[ query ][ target ]\n");
                    command_output.m_command_kind = QUERY_TARGET;
                    command_output.m_command_value = -1;
                }
                else if (strcmp(second_str, "all") == 0)
                {
                    printf("< command >[ query ][ all ]\n");
                    command_output.m_command_kind = QUERY_ALL;
                    command_output.m_command_value = -1;
                }
                else
                {
                    printf("< command >< ERROR >: Command is error!\n");
                    command_output.m_command_kind = COMMAND_ERROR;
                    command_output.m_command_value = -1;
                }
            }
        }
        else
        {
            if(strcmp(command_buffer, "start") == 0)
            {
                printf("< command >[ start ]\n");
                command_output.m_command_kind = RUN;
                command_output.m_command_value = -1;
            }
            else if(strcmp(command_buffer, "stop") == 0)
            {
                printf("< command >[ stop ]\n");
                command_output.m_command_kind = STOP;
                command_output.m_command_value = -1;
            }
            else if(strcmp(command_buffer, "charge") == 0)
            {
                printf("< command >[ charge ]\n");
                command_output.m_command_kind = CHARGE;
                command_output.m_command_value = CARD_ID_CHARGE;
            }
            else if(strcmp(command_buffer, "forward") == 0)
            {
                printf("< command >[ walk ][ forward ]\n");
                command_output.m_command_kind = WALK_FORWARD;
                command_output.m_command_value = -1;
            }
            else if(strcmp(command_buffer, "back") == 0)
            {
                printf("< command >[ walk ][ rear ]\n");
                command_output.m_command_kind = WALK_REAR;
                command_output.m_command_value = -1;
            }
            else if(strcmp(command_buffer, "left") == 0)
            {
                printf("< command >[ walk ][ left ]\n");
                command_output.m_command_kind = WALK_LEFT;
                command_output.m_command_value = -1;
            }
            else if(strcmp(command_buffer, "right") == 0)
            {
                printf("< command >[ walk ][ right ]\n");
                command_output.m_command_kind = WALK_RIGHT;
                command_output.m_command_value = -1;
            }
            else
            {
                printf("< command >< ERROR >: Command is error!\n");
                command_output.m_command_kind = COMMAND_ERROR;
                command_output.m_command_value = -1;
            }
        }
    }
    return command_output;

}

struct Robot translate_magnetic_2_motor(struct Robot robot, int magnetic_value)
{
    robot.m_magnetic_value  = magnetic_value;
    int temp = magnetic_value;
    int i = 0;
    while ( i < MAGNETIC_BUFFER_LEN)
    {
        robot.m_magnetic_status_0_1[i] = 0;
        robot.m_magnetic_status_0_1[i] = temp%2;
        temp = temp/2;
        i++;
    }

    int magnetic_value_right = robot.m_magnetic_status_0_1[0] + robot.m_magnetic_status_0_1[1] 
            + robot.m_magnetic_status_0_1[2] +robot.m_magnetic_status_0_1[3];
    int magnetic_value_left = robot.m_magnetic_status_0_1[4] + robot.m_magnetic_status_0_1[5] 
            + robot.m_magnetic_status_0_1[6] +robot.m_magnetic_status_0_1[7]; 

    int magnetic_diff = magnetic_value_left - magnetic_value_right;

    if ( robot.m_magnetic_status_0_1[7] == 0 
        && robot.m_magnetic_status_0_1[6] == 0 
        && robot.m_magnetic_status_0_1[5] == 0 
        && robot.m_magnetic_status_0_1[4] == 1)
    {
         robot.m_motor_left_value = (robot.m_speed + MOTOR_SPEED_DELTA);
         robot.m_motor_right_value = robot.m_speed;
    }
    else if (robot.m_magnetic_status_0_1[7] == 0 
                && robot.m_magnetic_status_0_1[6] == 0 
                && robot.m_magnetic_status_0_1[5] == 0
                && robot.m_magnetic_status_0_1[4] == 0
                && robot.m_magnetic_status_0_1[3] == 1)
    {
         robot.m_motor_left_value = (robot.m_speed + 1.5 * MOTOR_SPEED_DELTA);
         robot.m_motor_right_value = robot.m_speed;
    }
    else if (robot.m_magnetic_status_0_1[7] == 0 
                && robot.m_magnetic_status_0_1[6] == 0 
                && robot.m_magnetic_status_0_1[5] == 0
                && robot.m_magnetic_status_0_1[4] == 0
                && robot.m_magnetic_status_0_1[3] == 0
                && robot.m_magnetic_status_0_1[2] == 1)
    {
         robot.m_motor_left_value = (robot.m_speed + 2 * MOTOR_SPEED_DELTA);
         robot.m_motor_right_value = robot.m_speed - 2 * MOTOR_SPEED_DELTA;
    }
    else if (robot.m_magnetic_status_0_1[7] == 0 
                && robot.m_magnetic_status_0_1[6] == 0 
                && robot.m_magnetic_status_0_1[5] == 0
                && robot.m_magnetic_status_0_1[4] == 0
                && robot.m_magnetic_status_0_1[3] == 0
                && robot.m_magnetic_status_0_1[2] == 0
                && robot.m_magnetic_status_0_1[1] == 1)
    {
         robot.m_motor_left_value = (robot.m_speed + 3 * MOTOR_SPEED_DELTA);
         robot.m_motor_right_value = robot.m_speed - 3 * MOTOR_SPEED_DELTA;
    }
    else if (robot.m_magnetic_status_0_1[7] == 0 
                && robot.m_magnetic_status_0_1[6] == 0 
                && robot.m_magnetic_status_0_1[5] == 0
                && robot.m_magnetic_status_0_1[4] == 0
                && robot.m_magnetic_status_0_1[3] == 0
                && robot.m_magnetic_status_0_1[2] == 0
                && robot.m_magnetic_status_0_1[1] == 0
                && robot.m_magnetic_status_0_1[0] == 1)
    {
         robot.m_motor_left_value = (robot.m_speed + 6 * MOTOR_SPEED_DELTA);
         robot.m_motor_right_value = robot.m_speed - 6 * MOTOR_SPEED_DELTA;
    }
    else if (robot.m_magnetic_status_0_1[0] == 0 
                && robot.m_magnetic_status_0_1[1] == 0 
                && robot.m_magnetic_status_0_1[2] == 0 
                && robot.m_magnetic_status_0_1[3] == 1)
    {
         robot.m_motor_left_value = robot.m_speed;
         robot.m_motor_right_value = (robot.m_speed + MOTOR_SPEED_DELTA);
    }
    else if (robot.m_magnetic_status_0_1[0] == 0 
                && robot.m_magnetic_status_0_1[1] == 0 
                && robot.m_magnetic_status_0_1[2] == 0
                && robot.m_magnetic_status_0_1[3] == 0
                && robot.m_magnetic_status_0_1[4] == 1)
    {
         robot.m_motor_left_value = robot.m_speed;
         robot.m_motor_right_value = (robot.m_speed + 1.5 * MOTOR_SPEED_DELTA);
    }
    else if (robot.m_magnetic_status_0_1[0] == 0 
                && robot.m_magnetic_status_0_1[1] == 0 
                && robot.m_magnetic_status_0_1[2] == 0
                && robot.m_magnetic_status_0_1[3] == 0
                && robot.m_magnetic_status_0_1[4] == 0
                && robot.m_magnetic_status_0_1[5] == 1)
    {
         robot.m_motor_left_value = robot.m_speed - 2 * MOTOR_SPEED_DELTA;
         robot.m_motor_right_value = (robot.m_speed + 2 * MOTOR_SPEED_DELTA);
    }
    else if (robot.m_magnetic_status_0_1[0] == 0 
                && robot.m_magnetic_status_0_1[1] == 0 
                && robot.m_magnetic_status_0_1[2] == 0
                && robot.m_magnetic_status_0_1[3] == 0
                && robot.m_magnetic_status_0_1[4] == 0
                && robot.m_magnetic_status_0_1[5] == 0
                && robot.m_magnetic_status_0_1[6] == 1)
    {
         robot.m_motor_left_value = robot.m_speed - 3 * MOTOR_SPEED_DELTA;
         robot.m_motor_right_value = (robot.m_speed + 3 * MOTOR_SPEED_DELTA);
    }
    else if (robot.m_magnetic_status_0_1[0] == 0 
                && robot.m_magnetic_status_0_1[1] == 0 
                && robot.m_magnetic_status_0_1[2] == 0
                && robot.m_magnetic_status_0_1[3] == 0
                && robot.m_magnetic_status_0_1[4] == 0
                && robot.m_magnetic_status_0_1[5] == 0
                && robot.m_magnetic_status_0_1[6] == 0
                && robot.m_magnetic_status_0_1[7] == 1)
    {
         robot.m_motor_left_value = robot.m_speed - 6 * MOTOR_SPEED_DELTA;
         robot.m_motor_right_value = (robot.m_speed + 6 * MOTOR_SPEED_DELTA);
    }
    else
    {
        robot.m_motor_left_value = robot.m_speed; 
        robot.m_motor_right_value = robot.m_speed; 
    }

    if (robot.m_motor_left_value < 0)
    {
        robot.m_motor_left_value = 0;
    }
    if (robot.m_motor_right_value < 0)
    {
        robot.m_motor_right_value = 0;
    }

    return robot;
}
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21
  • 22
  • 23
  • 24
  • 25
  • 26
  • 27
  • 28
  • 29
  • 30
  • 31
  • 32
  • 33
  • 34
  • 35
  • 36
  • 37
  • 38
  • 39
  • 40
  • 41
  • 42
  • 43
  • 44
  • 45
  • 46
  • 47
  • 48
  • 49
  • 50
  • 51
  • 52
  • 53
  • 54
  • 55
  • 56
  • 57
  • 58
  • 59
  • 60
  • 61
  • 62
  • 63
  • 64
  • 65
  • 66
  • 67
  • 68
  • 69
  • 70
  • 71
  • 72
  • 73
  • 74
  • 75
  • 76
  • 77
  • 78
  • 79
  • 80
  • 81
  • 82
  • 83
  • 84
  • 85
  • 86
  • 87
  • 88
  • 89
  • 90
  • 91
  • 92
  • 93
  • 94
  • 95
  • 96
  • 97
  • 98
  • 99
  • 100
  • 101
  • 102
  • 103
  • 104
  • 105
  • 106
  • 107
  • 108
  • 109
  • 110
  • 111
  • 112
  • 113
  • 114
  • 115
  • 116
  • 117
  • 118
  • 119
  • 120
  • 121
  • 122
  • 123
  • 124
  • 125
  • 126
  • 127
  • 128
  • 129
  • 130
  • 131
  • 132
  • 133
  • 134
  • 135
  • 136
  • 137
  • 138
  • 139
  • 140
  • 141
  • 142
  • 143
  • 144
  • 145
  • 146
  • 147
  • 148
  • 149
  • 150
  • 151
  • 152
  • 153
  • 154
  • 155
  • 156
  • 157
  • 158
  • 159
  • 160
  • 161
  • 162
  • 163
  • 164
  • 165
  • 166
  • 167
  • 168
  • 169
  • 170
  • 171
  • 172
  • 173
  • 174
  • 175
  • 176
  • 177
  • 178
  • 179
  • 180
  • 181
  • 182
  • 183
  • 184
  • 185
  • 186
  • 187
  • 188
  • 189
  • 190
  • 191
  • 192
  • 193
  • 194
  • 195
  • 196
  • 197
  • 198
  • 199
  • 200
  • 201
  • 202
  • 203
  • 204
  • 205
  • 206
  • 207
  • 208
  • 209
  • 210
  • 211
  • 212
  • 213
  • 214
  • 215
  • 216
  • 217
  • 218
  • 219
  • 220
  • 221
  • 222
  • 223
  • 224
  • 225
  • 226
  • 227
  • 228
  • 229
  • 230
  • 231
  • 232
  • 233
  • 234
  • 235
  • 236
  • 237
  • 238
  • 239
  • 240
  • 241
  • 242
  • 243
  • 244
  • 245
  • 246
  • 247
  • 248
  • 249
  • 250
  • 251
  • 252
  • 253
  • 254
  • 255
  • 256
  • 257
  • 258
  • 259
  • 260
  • 261
  • 262
  • 263
  • 264
  • 265
  • 266
  • 267
  • 268
  • 269
  • 270
  • 271
  • 272
  • 273
  • 274
  • 275
  • 276
  • 277
  • 278
  • 279
  • 280
  • 281
  • 282
  • 283
  • 284
  • 285
  • 286
  • 287
  • 288
  • 289
  • 290
  • 291
  • 292
  • 293
  • 294
  • 295
  • 296
  • 297
  • 298
  • 299
  • 300
  • 301
  • 302
  • 303
  • 304
  • 305
  • 306
  • 307
  • 308
  • 309
  • 310
  • 311
  • 312
  • 313
  • 314
  • 315
  • 316
  • 317
  • 318
  • 319
  • 320
  • 321
  • 322
  • 323
  • 324
  • 325
  • 326
  • 327
  • 328
  • 329
  • 330
  • 331
  • 332
  • 333
  • 334
  • 335
  • 336
  • 337
  • 338
  • 339
  • 340
  • 341
  • 342
  • 343
  • 344
  • 345
  • 346
  • 347
  • 348
  • 349
  • 350
  • 351
  • 352
  • 353
  • 354
  • 355
  • 356
  • 357
  • 358
  • 359
  • 360
  • 361
  • 362
  • 363
  • 364
  • 365
  • 366
  • 367
  • 368
  • 369
  • 370
  • 371
  • 372
  • 373
  • 374
  • 375
  • 376
  • 377
  • 378
  • 379
  • 380
  • 381
  • 382
  • 383
  • 384
  • 385
  • 386
  • 387
  • 388
  • 389
  • 390
  • 391
  • 392
  • 393
  • 394
  • 395
  • 396
  • 397
  • 398
  • 399
  • 400
  • 401
  • 402
  • 403
  • 404
  • 405
  • 406
  • 407
  • 408
  • 409
  • 410
  • 411
  • 412
  • 413
  • 414
  • 415
  • 416
  • 417
  • 418
  • 419
<

usart.c
增加两段代码，用于串口通信

/* USER CODE BEGIN 0 */
#include "stm32f1xx_hal.h"
#include <stdio.h>
/* USER CODE END 0 */
  • 1
  • 2
  • 3
  • 4
/* USER CODE BEGIN 1 */
int fputc(int ch, FILE *f)
{
    HAL_UART_Transmit(&huart1, (uint8_t *)&ch, 1, 0xffff);
    return ch;
}
int fgetc(FILE *f)
{
    uint8_t ch = 0;
    HAL_UART_Receive(&huart1, &ch, 1, 0xffff);
    return ch;
}
/* USER CODE END 1 */
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13

总结

至此我们完成了一个磁条机器人的开发工作。我们也顺利的结束这一专栏吧。
之后我想会写一些关于AMR的知识和算法，敬请期待

声明：本文内容由易百纳平台入驻作者撰写，文章观点仅代表作者本人，不代表易百纳立场。如有内容侵权或者其他问题，请联系本站进行删除。
MOmo
红包 点赞 收藏 评论 打赏
  • 分享
  • 举报
评论
0个
时间排序
内容存在敏感词
手气红包
    易百纳技术社区暂无数据
相关专栏
关于作者
MOmo

MOmo

暂无个性签名~

原创9
阅读1.1w
收藏0
点赞0
评论0
TA最新文章
打赏用户 共 0 位
我要创作
分享技术经验，可获取创作收益
分类专栏
热门专栏
置顶时间设置
结束时间
删除原因
  • 广告/SPAM
  • 恶意灌水
  • 违规内容
  • 文不对题
  • 重复发帖
打赏作者
易百纳技术社区
MOmo
您的支持将鼓励我继续创作！
打赏金额：
￥1易百纳技术社区
￥5易百纳技术社区
￥10易百纳技术社区
￥50易百纳技术社区
￥100易百纳技术社区
支付方式：
微信支付
支付宝支付
易百纳技术社区微信支付
易百纳技术社区
打赏成功!

感谢您的打赏，如若您也想被打赏，可前往 发表专栏 哦~

举报反馈

举报类型

  • 内容涉黄/赌/毒
  • 内容侵权/抄袭
  • 政治相关
  • 涉嫌广告
  • 侮辱谩骂
  • 其他

详细说明

审核成功

发布时间设置
立即发布
延迟发布
发布时间：
是否关联周任务-专栏模块
是
否

审核失败

失败原因
备注
拼手气红包 红包规则
祝福语
恭喜发财，大吉大利！
红包金额
元
红包最小金额不能低于5元
红包数量
个
红包数量范围10~50个
余额支付
当前余额：
可前往问答、专栏板块获取收益 去获取
取 消 确 定

小包子的红包

恭喜发财，大吉大利

红包规则
开

已领取20/40，共1.6元 红包规则

    易百纳技术社区