plan_grasp

This script can be used to test out the gqcnn_grasp_planner python module.

Note

Usage: To visualize the grasp please set the vis settings in the ../cfg/main_config.yaml.

Source code

 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
# Main python packages
import os

# Panda_autograsp modules, msgs and srvs
from panda_autograsp import Logger
from panda_autograsp.grasp_planners import GraspPlanner

# Create script logger
script_logger = Logger.get_logger("plan_grasp.py")

#################################################
# Script settings ###############################
#################################################
MODEL_NAME = "GQCNN-4.0-PJ"

#################################################
# Main script ###################################
#################################################
if __name__ == "__main__":

    # Welcome message
    print(
        "== Plan grasp script ==\n"
        "This script can be used to test the "
        "'gqcnn_grasp_planner python' module.\n"
        "\n"
        "Usage: To show the computed grasp edit "
        "the vis settings in the `cfg/main_config.yaml` file."
    )

    # set root logger format
    root_logger = Logger.get_logger(
        log_file=os.path.abspath(
            os.path.join(
                os.path.dirname(os.path.realpath(__file__)), "..", "logs/plan_grasp.log"
            )
        )
    )

    # Create a grasp planner
    grasp_planner = GraspPlanner(model=MODEL_NAME)

    # Plan a grasp and display the result
    grasp_planner.start()
    grasp = grasp_planner.plan_grasp()

    # Print log message
    if grasp:
        script_logger.info(
            "Grasp computed successfully shutting down plan_grasp.py script."
        )
    else:
        script_logger.info(
            "Grasp computation failed shutting down plan_grasp.py script."
        )