如何使伺服Dynamixel电机从0 --> 90 --> 180 --> 220-->0度移动

import dynamixel_sdk as dxl

# 控制器和电机参数设置
port = '/dev/ttyUSB0'  # 串口号
baudrate = 57600  # 波特率
motor_id = 1  # 电机ID

# 初始化控制器
packet_handler = dxl.PacketHandler(1.0)
port_handler = dxl.PortHandler(port)
port_handler.openPort()
port_handler.setBaudRate(baudrate)

# 设置电机目标位置
target_position = [0, 90, 180, 220, 0]  # 目标位置列表

for position in target_position:
    dxl_goal_position = int(position * 4095 / 360)  # 将角度转换为电机控制值
    dxl.write4ByteTxRx(port_handler, motor_id, 30, dxl_goal_position)  # 写入目标位置

# 关闭串口
port_handler.closePort()