Implement connection detection
Applicable devices
- myCobot 280 Pi
- myCobot 320 Pi
- mechArm 270 Pi
Operation steps
Step 1: Atom burns the latest version of atomMain.
Step 2: Create a new Python file *.py on the desktop, copy the following code into it and save it.
Note: The file is named: myCobot_test_demo_CN.py.
from pymycobot.mycobot import MyCobot
LOG_NUM = 0
class MycobotTest(object):
def __init__(self):
self.mycobot = None
self.win = tkinter.Tk()
self.win.title("Raspberry Pi version of myCobot testing tool")
self.win.geometry("918x480+10+10")
self.port_label = tkinter.Label(self.win, text="Select the serial port:")
self.port_label.grid(row=0)
self.port_list = ttk.Combobox(
self.win, width=15, postcommand=self.get_serial_port_list
) # #Create a drop-down menu
self.get_serial_port_list() # #Set a value for the drop-down menu
self.port_list.current(0)
self.port_list.grid(row=0, column=1)
self.baud_label = tkinter.Label(self.win, text="Select the baud rate:")
self.baud_label.grid(row=1)
self.baud_list = ttk.Combobox(self.win, width=15)
self.baud_list["value"] = ("1000000", "115200")
self.baud_list.current(1)
self.baud_list.grid(row=1, column=1)
# Connect
self.connect_label = tkinter.Label(self.win, text="Connect mycobot:")
self.connect_label.grid(row=2)
self.connect = tkinter.Button(self.win, text="connect", command=self.connect_mycobot)
self.disconnect = tkinter.Button(
self.win, text="disconnect", command=self.disconnect_mycobot
)
self.connect.grid(row=3)
self.disconnect.grid(row=3, column=1)
# Check servo.
self.check_label = tkinter.Label(self.win, text="Detect connection:")
self.check_label.grid(row=4)
self.check_btn = tkinter.Button(
self.win, text="Start detection", command=self.check_mycobot_servos
)
self.check_btn.grid(row=4, column=1)
# LED.
self.set_color_label = tkinter.Label(self.win, text="Testing the Atom Light Board:")
self.set_color_label.grid(row=5, columnspan=2)
self.color_red = tkinter.Button(
self.win, text="Set Red", command=lambda: self.send_color("red")
)
self.color_green = tkinter.Button(
self.win, text="Set Green", command=lambda: self.send_color("green")
)
self.color_red.grid(row=6)
self.color_green.grid(row=6, column=1)
# Log output.
self.log_label = tkinter.Label(self.win, text="log：")
self.log_label.grid(row=0, column=12)
_f = tkinter.Frame(self.win)
_bar = tkinter.Scrollbar(_f, orient=tkinter.VERTICAL)
self.log_data_Text = tkinter.Text(
_f, width=100, height=35, yscrollcommand=_bar.set
)
_bar.pack(side=tkinter.RIGHT, fill=tkinter.Y)
_bar.config(command=self.log_data_Text.yview)
self.log_data_Text.pack()
# self.log_data_Text.grid(row=1, column=12, rowspan=15, columnspan=10)
_f.grid(row=1, column=12, rowspan=15, columnspan=10)
def run(self):
self.win.mainloop() # run
# ============================================================
# Connect method
# ============================================================
def connect_mycobot(self):
self.prot = port = self.port_list.get()
if not port:
self.write_log_to_Text("Please select the serial port")
return
self.baud = baud = self.baud_list.get()
if not baud:
self.write_log_to_Text("Please select the baud rate")
return
baud = int(baud)
try:
# self.mycobot = MyCobot(PI_PORT, PI_BAUD)
self.mycobot = MyCobot(port, baud)
time.sleep(0.5)
self.mycobot._write([255,255,3,22,1,250])
time.sleep(0.5)
# self.mycobot = MyCobot("/dev/cu.usbserial-0213245D", 115200)
self.write_log_to_Text("connection succeeded !")
except Exception as e:
err_log = """\
\rConnection failed !!!
\r=================================================
{}
\r=================================================
""".format(
e
)
self.write_log_to_Text(err_log)
def disconnect_mycobot(self):
if not self.has_mycobot():
return
try:
del self.mycobot
self.mycobot = None
self.write_log_to_Text("Disconnected successfully!")
except AttributeError:
self.write_log_to_Text("Mycobot is not connected yet!!!")
# ============================================================
# Function method
# ============================================================
def check_mycobot_servos(self):
if not self.has_mycobot():
return
res = []
for i in range(1,8):
_data = self.mycobot.get_servo_data(i , 5)
time.sleep(0.02)
if _data != i:
res.append(i)
if res:
self.write_log_to_Text("Joint {} cannot communicate!!!".format(res))
else:
self.write_log_to_Text("All joints are connected normally.")
def send_color(self, color: str):
if not self.has_mycobot():
return
color_dict = {
"red": [255, 0, 0],
"green": [0, 255, 0],
"blue": [0, 0, 255],
}
self.mycobot.set_color(*color_dict[color])
self.write_log_to_Text("Send color: {}.".format(color))
# ============================================================
# Utils method
# ============================================================
def has_mycobot(self):
"""Check whether it is connected on mycobot"""
if not self.mycobot:
self.write_log_to_Text("Mycobot is not connected yet!!!")
return False
return True
def get_serial_port_list(self):
plist = [
str(x).split(" - ")[0].strip() for x in serial.tools.list_ports.comports()
]
print(plist)
self.port_list["value"] = plist
return plist
def get_current_time(self):
"""Get current time with format."""
current_time = time.strftime("%Y-%m-%d %H:%M:%S", time.localtime(time.time()))
return current_time
def write_log_to_Text(self, logmsg: str):
global LOG_NUM
current_time = self.get_current_time()
logmsg_in = str(current_time) + " " + str(logmsg) + "\n"
if LOG_NUM <= 18:
self.log_data_Text.insert(tkinter.END, logmsg_in)
LOG_NUM += len(logmsg_in.split("\n"))
# print(LOG_NUM)
else:
self.log_data_Text.insert(tkinter.END, logmsg_in)
self.log_data_Text.yview("end")
if __name__ == "__main__":
MycobotTest().run()
Step 3: Open a control terminal and enter the following command:
cd ~/Desktop/
python3 myCobot_test_demo_CN.py
Step 4: Select the baud rate corresponding to the device and click Connect.
- myCobot 280-Pi: 1000000
- myCobot 320-Pi: 115200
.jpg)
Step 5: Set each joint of the robot arm to zero position and click Start detection.
Step 6: Wait for the interface to show Joint [7] cannot communicate! , the robot device detection is normal.
.jpg)
Step 7: The two buttons here can change the color of the Atom LED
.png)
.png)