Skip to content
TheChatArchiveThe Chat Archive
gpt-3.5-turbo-0301· openaiHugging Face Suzhen/CodeChat

如何用TBS-K20型号的舵机和拥有TCS3200颜色识别模块的开发板STM32c8t6来实现颜色识别控制机械臂

  1. User

    如何用TBS-K20型号的舵机和拥有TCS3200颜色识别模块的开发板STM32c8t6来实现颜色识别控制机械臂

  2. Assistant

    要使用TBS-K20型号的舵机和拥有TCS3200颜色识别模块的开发板STM32c8t6来实现颜色识别控制机械臂,可以按照以下步骤进行操作:

    1. 将TCS3200颜色识别模块连接到开发板上,设置好引脚和电源等连接方式。

    2. 使用开发板进行程序编写和上传,编写代码实现颜色识别功能。

    3. 将TBS-K20型号的舵机连接到开发板上,设置好引脚和电源等连接方式。

    4. 使用开发板进行程序编写和上传,编写代码实现机械臂的控制功能。

    5. 在程序中将颜色识别和机械臂控制结合起来,实现在识别到颜色后控制机械臂执行对应的动作。

    需要注意的是,在编写程序时需要根据具体的接口和引脚配置等不同于其他设备的特殊情况进行相应的处理和调整。另外,该方案实现颜色识别和机械臂控制需要一定的技术和基础,需要熟练掌握编程和硬件电路等基础知识。

  3. User

    我想要具体步骤和详细的代码,以及代码应该输入到哪里

  4. Assistant

    具体步骤和详细代码如下:

    1. TCS3200颜色识别模块连接

    首先需要将TCS3200颜色识别模块连接到开发板上。连接方式如下图所示:

    [image: TCS3200颜色识别模块连接方式] open

    其中,VCC和GND分别连接至开发板的5V和GND电源端口上,OUT连接至开发板的一个数字IO口上,S0、S1、S2、S3连接至开发板的4个数字IO口上。

    1. 程序编写和上传

    使用STMCubeMX软件进行程序编写,在程序中先引入所需的库文件头文件:

    #include "cmsis_os.h"
    #include "stdbool.h"
    #include "stdio.h"
    #include "stm32f1xx_hal.h"
    

    在main函数中初始化IO口等:

    /* USER CODE BEGIN 2 */
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_11, GPIO_PIN_RESET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_10, GPIO_PIN_RESET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_1, GPIO_PIN_SET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_SET);
        MPU_Init(&hi2c1);
        cssystimer_init(3, 719);
        MPU_i2cscan(0, 20);
        serv_init(&htim3, &htim4);//初始化舵机
        IR_Init();//初始化红外模块
        LCD_Init();//初始化lcd
        LCD_Clear(LCD_COLOR_WHITE);
        ADC0_Init();//初始化ADC
        ssd1306_Init();//初始化OLED
        while (TCS_cnt < 10)TCS_cnt = TCS_Read();//TSC3200传感器复位,
    
        /* USER CODE END 2 */
    

    然后编写函数实现TCS3200颜色识别:

    uint8_t TCS_Read(void)
    {
        uint8_t cl = 0, ch = 0;
        float r, g, b;
        uint8_t red, green, blue, result;
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_RESET);//开始转动
        osDelay(70);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_SET);//停止转动
        osDelay(10);
    
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_11, GPIO_PIN_SET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_10, GPIO_PIN_RESET);
        osDelay(10);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_10, GPIO_PIN_SET);
        osDelay(10);
        ch = TIM1->CCR1;
        cl = TIM1->CCR2;
        r = (float)ch / (float)(ch + cl);
    
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_11, GPIO_PIN_RESET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_10, GPIO_PIN_RESET);
        osDelay(10);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_10, GPIO_PIN_SET);
        osDelay(10);
        ch = TIM1->CCR1;
        cl = TIM1->CCR2;
        g = (float)ch / (float)(ch + cl);
    
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_11, GPIO_PIN_SET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_10, GPIO_PIN_SET);
        osDelay(10);
        ch = TIM1->CCR1;
        cl = TIM1->CCR2;
        b = (float)ch / (float)(ch + cl);
    
        red = r * 255.0;
        green = g * 255.0;
        blue = b * 255.0;
    
        printf("red=%d,green=%d,blue=%d\n", red, green, blue);//向串口发送数据
    
        if ((red >= 158) && (green <= 143) && (blue <= 118))//根据red、green、blue三个的值来判断颜色
        {
            printf("orange\n");
            result = 0;//返回0表示识别到了红色
        }
        else if ((red <= 150) && (green >= 170) && (blue <= 160))
        {
            printf("green\n");
            result = 1;//返回1表示识别到了绿色
        }
        else if ((red <= 140) && (green <= 170) && (blue >= 210))
        {
            printf("blue\n");
            result = 2;//返回2表示识别到了蓝色
        }
        else
        {
            printf("nothing\n");
        }
        return result;
    }
    
    1. TBS-K20型号的舵机连接及控制

    将TBS-K20型号的舵机连接到开发板上,使用下列代码来控制它:

    //定义定时器
    TIM_HandleTypeDef htim3;
    TIM_HandleTypeDef htim4;
    
    void serv_init(void)
    {
        htim3.Instance = TIM3;
        htim3.Init.Prescaler = 89;
        htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
        htim3.Init.Period = 20000;
        htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
        if (HAL_TIM_Base_Init(&htim3) != HAL_OK)
        {
            Error_Handler();
        }
        HAL_TIM_Base_Start(&htim3);
    
        htim4.Instance = TIM4;
        htim4.Init.Prescaler = 89;
        htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
        htim4.Init.Period = 20000;
        htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
        if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
        {
            Error_Handler();
        }
        HAL_TIM_Base_Start(&htim4);
    }
    
    void set_servo_pwm(servo_num sn, unsigned short pwm)
    {
        switch (sn)
        {
        case LEFT:
            __HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_1, pwm);
            break;
        case RIGHT:
            __HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_2, pwm);
            break;
        case UP:
            __HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_3, pwm);
            break;
        case DOWN:
            __HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_4, pwm);
            break;
        case CLAW:
            __HAL_TIM_SET_COMPARE(&htim4, TIM_CHANNEL_1, pwm);
            break;
        }
    }
    

    在代码中使用set_servo_pwm函数设置舵机角度来实现机械臂的控制。

    1. 颜色识别和机械臂控制的结合

    最终的代码需要将前两步编写的代码结合起来,即在识别到颜色之后使用set_servo_pwm函数控制机械臂执行对应的动作。具体代码如下:

    void color_recognize_task(void const *arg)
    {
        while (1)
        {
            LCD_Clear(LCD_COLOR_WHITE);
            TCS_cnt = 0;
    
            while (TCS_cnt < 10)//循环读取数据来稳定
            {
                TCS_cnt++;
                color = TCS_Read();
                osDelay(100);
            }
    
            if (color == 0)//红色
            {
                set_servo_pwm(DOWN, 1900);
                osDelay(1000);
                set_servo_pwm(CLAW, 1500);
                osDelay(1000);
                set_servo_pwm(DOWN, 1200);
                osDelay(1000);
                set_servo_pwm(CLAW, 1900);
                osDelay(1000);
                set_servo_pwm(DOWN, 1900);
                osDelay(1000);
            }
            else if (color == 1)//绿色
            {
                set_servo_pwm(LEFT, 1100);
                osDelay(1000);
                set_servo_pwm(UP, 1100);
                osDelay(1000);
                set_servo_pwm(CLAW, 1900);
                osDelay(1000);
                set_servo_pwm(LEFT, 1900);
                osDelay(1000);
                set_servo_pwm(UP, 1900);
                osDelay(1000);
            }
            else if (color == 2)//蓝色
            {
                set_servo_pwm(LEFT, 1400);
                osDelay(1000);
                set_servo_pwm(DOWN, 1900);
                osDelay(1000);
                set_servo_pwm(CLAW, 1500);
                osDelay(1000);
                set_servo_pwm(DOWN, 1200);
                osDelay(1000);
                set_servo_pwm(CLAW, 1900);
                osDelay(1000);
                set_servo_pwm(DOWN, 1900);
                osDelay(1000);
                set_servo_pwm(LEFT, 1900);
                osDelay(1000);
            }
            else
            {
                LCD_ShowString(10, 10, "No color detected!");
            }
    
            osDelay(1000);
        }
    }
    

    其中,color_recognize_task函数是一个独立的任务,用来循环读取颜色传感器的值,并根据识别结果控制机械臂执行相应的动作。需要在main函数或者其他主函数中启动该任务,例如:

    int main(void)
    {
        HAL_Init();
        SystemClock_Config();
    
        //启动颜色识别任务
        osThreadDef(color_recognize_task, color_recognize_task, osPriorityNormal, 0, 512);
        color_recognize_handle = osThreadCreate(osThread(color_recognize_task), NULL);
    
        /* USER CODE BEGIN 2 */
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_11, GPIO_PIN_RESET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_10, GPIO_PIN_RESET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_1, GPIO_PIN_SET);
        HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3, GPIO_PIN_SET);
        MPU_Init(&hi2c1);
        cssystimer_init(3, 719);
        MPU_i2cscan(0, 20);
        serv_init(&htim3, &htim4);//初始化舵机
        IR_Init();//初始化红外模块
        LCD_Init();//初始化lcd
        LCD_Clear(LCD_COLOR_WHITE);
        ADC0_Init();//初始化ADC
        ssd1306_Init();//初始化OLED
        while (TCS_cnt < 10)TCS_cnt = TCS_Read();//TSC3200传感器复位,
        /* USER CODE END 2 */
    
        //开始调度RTOS操作系统
        osKernelStart();
    
        while (1)
        {
        }
    }
    

    在调试或正式运行时,可以在开发板上通过串口等方式观察输入输出的信息。代码应该输入到main.c或者其他用户代码文件中,这些文件需要在编译时链接到主函数所在的文件中。

  5. User

    你上面用到的软件是STMCubeMX,而我的软件是STMCubeIDE,这个咋办

  6. Assistant

    STMCubeMX是一款非常好用的STM32代码生成工具,但是也有一些限制。如果你使用的是STMCubeIDE,那么可以通过以下步骤来编写和上传代码:

    1. 创建工程

    首先需要创建一个新工程,在“File”菜单中选择“New”->“STM32 Project”。

    在弹出的对话框中输入项目名称和所选的开发板型号等信息,然后点击“Finish”按钮。

    1. 编写代码

    在创建好的工程中,你可以打开main.c文件,进行代码的编写。需要注意的是,STMCubeIDE使用的是C语言,有些代码可能需要进行一些调整,以适应不同的编译器和开发环境。

    1. 设置芯片信息

    在代码前面需要设置芯片型号和一些其他的信息,例如:

    #include "main.h"
    #include "stm32f4xx_hal.h"
    
    /* Private variables ---------------------------------------------------------*/
    ADC_HandleTypeDef hadc1;
    TIM_HandleTypeDef htim4;
    
    UART_HandleTypeDef huart1;
    
    /* Private function prototypes -----------------------------------------------*/
    void SystemClock_Config(void);
    static void MX_GPIO_Init(void);
    static void MX_TIM4_Init(void);
    static void MX_ADC1_Init(void);
    static void MX_USART1_UART_Init(void);
    
    ...
    
    int main(void)
    {
      // 启动HAL库
      HAL_Init();
    
      // 配置系统时钟
      SystemClock_Config();
    
      // 配置GPIO、定时器、ADC等外设
      MX_GPIO_Init();
      MX_TIM4_Init();
      MX_ADC1_Init();
      MX_USART1_UART_Init();
    
      // 启动定时器
      HAL_TIM_Base_Start_IT(&htim4);
    
      // 主循环
      while (1)
      {
    
      }
    }
    

    需要根据具体情况进行相应的设置。

    1. 编译和上传

    在代码编写完成后,可以进行编译和上传,以在开发板上运行程序。可以使用ST-Link或其他调试器进行调试和上传操作。

    实际操作时,可以参考STMCubeIDE的用户手册和相关教程,按照自己实际情况进行调整和修改。

Responses were produced in different, uncontrolled contexts (system prompts, settings, prior turns). This is not a benchmark.