Control robotic arm joint angle

1. Introduction to API

power_off()

Function : Uninstall the robotic arm.

After uninstallation, the robot arm will no longer maintain its posture and can be moved by hand.

Parameter explanation:

• Return value: None

power_on()

Function: Enable the robotic arm. After enabling, do not move the robotic arm by hand.

Parameter explanation:

• Return value: None

2. About code

Code path：~/jetcobot_ws/src/jetcobot_ctrl/scripts/ctrl_joints.ipynb

Create three new buttons to control the robotic arm reset, enable, and uninstall functions.

def on_button_clicked(b):
    with output:
        print("Button clicked:", b.description)
    if b.description == 'Reset':
        reset_joints()
    elif b.description == 'Power_on':
        mc.power_on()
        b.icon = 'check'
        button_power_off.icon = 'uncheck'
    elif b.description == 'Power_off':
        mc.power_off()
        b.icon = 'check'
        button_power_on.icon = 'uncheck'

Create seven new sliders to control the six joints and grippers of the robot arm.

xxxxxxxxxx
def on_slider_S1(angle):
    print("J1:", angle)
    mc.send_angle(1, angle, g_speed)
def on_slider_S2(angle):
    print("J2:", angle)
    mc.send_angle(2, angle, g_speed)
def on_slider_S3(angle):
    print("J3:", angle)
    mc.send_angle(3, angle, g_speed)
def on_slider_S4(angle):
    print("J4:", angle)
    mc.send_angle(4, angle, g_speed)
def on_slider_S5(angle):
    print("J5:", angle)
    mc.send_angle(5, angle, g_speed)
def on_slider_S6(angle):
    print("J6:", angle)
    mc.send_angle(6, angle, g_speed) 
def on_slider_S7(angle):
    print("G7:", angle)
    mc.set_gripper_value(angle, g_speed)

Create a new slider to control the movement speed of the servo.

​x
slider_speed = widgets.IntSlider(description='Speed:', value=50, min=1, max=100, step=1, orientation='horizontal')

def on_slider_speed(value):
    global mc, g_speed
    g_speed = value
    print("speed:", value)

widget_speed = widgets.interactive(on_slider_speed, value=slider_speed)

Reset the joint angles of the robotic arm.

xxxxxxxxxx
def reset_joints():
    if button_power_off.icon == 'check':
        mc.power_on()
        time.sleep(1)
    mc.send_angles([0, 0, 0, 0, 0, -45], 50)
    mc.set_gripper_value(100, 50)
    slider_S1.value = 0
    slider_S2.value = 0
    slider_S3.value = 0
    slider_S4.value = 0
    slider_S5.value = 0
    slider_S6.value = -45
    slider_S7.value = 100
    slider_speed.value = 50
    button_power_on.icon = 'check'
    button_power_off.icon = 'uncheck'

Create a camera display window to read the camera image in real time and display it.

xxxxxxxxxx
imgbox = widgets.Image(format='jpg', width=640, height=480, layout=widgets.Layout(align_self='center'))
model = 'Start'

xxxxxxxxxx
def camera():
    global model
    capture = cv.VideoCapture(0)
    capture.set(cv.CAP_PROP_FRAME_WIDTH, 640)
    capture.set(cv.CAP_PROP_FRAME_HEIGHT, 480)
    while capture.isOpened():
        try:
            _, img = capture.read()
            if model == 'Exit':
                break
            imgbox.value = cv.imencode('.jpg', img)[1].tobytes()
        except:
            break
    with output:
        print("capture release")
    capture.release()

Create a close button to end the program and release resources.

xxxxxxxxxx
button_close = widgets.Button(description='Close_Camera', button_style="danger")
def button_close_Callback(value):
    global model
    model = 'Exit'
    with output: print(model)
button_close.on_click(button_close_Callback)

3.Run program

Click the Run Entire Program button on the Jupyterlab toolbar and scroll to the bottom.

You can see that the relevant control controls are displayed on the left and the camera display screen is displayed on the right.

The corresponding positions of the robotic arm joints, are shown in the figure below.