샘플 프로그램 20: MM_S20_Viz_PlanAllVision
프로그램 소개
기능 설명 |
로봇이 Mech-Viz 프로젝트 실행을 트리거한 후 루프를 통해 모든 계획된 경로를 획득하여 피킹 및 배치 작업을 수행합니다. 이 샘플에서는 카메라가 이미지를 한 번만 캡처하면 Mech-Viz가 모든 비전 결과에 대한 피킹 경로를 계획합니다. 일반적으로 멀티 피킹 시나리오에 적용합니다. |
||
파일 경로 |
Mech-Vision 및 Mech-Viz의 설치 디렉토리로 이동하여 |
||
필요한 프로젝트 |
Mech-Vision와 Mech-Viz 프로젝트
![]() |
||
사용 전제 조건 |
|
이 샘플 프로그램은 참고용으로 제공됩니다. 사용자는 실제 상황에 맞춰 이 내용을 바탕으로 수정해야 하며, 해당 프로그램을 그대로 사용하지 않도록 하십시오. |
프로그램 설명
다음에는 MM_S20_Viz_PlanAllVision 샘플 프로그램의 코드와 관련 설명입니다.
MM_S2_Viz_Basic 샘플과 비하면, 이 샘플은 루프를 통해 모든 계획된 경로를 획득하여 피킹 및 배치 작업을 수행하는 기능만 수정되었습니다.(이 부분의 코드는 굵게 표시됨) 따라서,MM_S20_Viz_PlanAllVision의 MM_S2_Viz_Basic과 일치하는 부분은 다시 설명하지 않습니다. (일치하는 부분에 대한 정보는 MM_S2_Viz_Basic샘플 프로그램 설명을 참조하십시오). |
1: !-------------------------------- ;
2: !FUNCTION: trigger Mech-Viz ;
3: !project, plan all vision results ;
4: !and get all planned results ;
5: !using command 210 ;
6: !Mech-Mind, 2023-12-25 ;
7: !-------------------------------- ;
8: ;
9: !set current uframe NO. to 0 ;
10: UFRAME_NUM=0 ;
11: !set current tool NO. to 1 ;
12: UTOOL_NUM=1 ;
13: !move to robot home position ;
14:J P[1] 100% FINE ;
15: !initialize communication ;
16: !parameters(initialization is ;
17: !required only once) ;
18: CALL MM_INIT_SKT('8','127.0.0.1',50000,5) ;
19: LBL[1:recap] ;
20: !move to image-capturing position ;
21:L P[2] 1000mm/sec FINE ;
22: !trigger Mech-Viz project ;
23: CALL MM_START_VIZ(2,10) ;
24: !get planned path ;
25: CALL MM_GET_PLNDT(0,3,51,52,53) ;
26: !check whether planned path has ;
27: !been got from Mech-Viz ;
28: !successfully ;
29: IF R[53]<>2100,JMP LBL[99] ;
30: !save all waypoint data to local ;
31: !variables using for-loop, a ;
32: !maximum of 50 points are support ;
33: !supported ;
34: FOR R[10]=1 TO R[51] ;
35: R[11]=59+R[10] ;
36: R[12]=R[10]*30 ;
37: R[13]=31+R[12] ;
38: R[14]=32+R[12] ;
39: R[15]=33+R[12] ;
40: R[16]=34+R[12] ;
41: R[17]=40+R[12] ;
42: CALL MM_GET_PLJOP(R[10],3,R[11],R[13],R[14],R[15],R[16],R[17]) ;
43: ENDFOR ;
44: !parse pick cycle count, here ;
45: !suppose 3 points per planned ;
46: !path ;
47: R[30]=R[51] DIV 3 ;
48: R[31]=R[51] MOD 3 ;
49: !check if parsed data is valid; ;
50: !if not, retry to get planned ;
51: !path or add some error handling ;
52: !logic ;
53: IF R[30]<1) OR (R[31]<>0 THEN ;
54: PAUSE ;
55: JMP LBL[1] ;
56: ENDIF ;
57: !repeatedly run pick-and-place ;
58: !cycle using for-loop ;
59: FOR R[10]=1 TO R[30] ;
60: R[20]=R[10]-1 ;
61: R[21]=R[20]*3 ;
62: R[31]=60+R[21] ;
63: R[32]=61+R[21] ;
64: R[33]=62+R[21] ;
65: !move to intermediate waypoint ;
66: !of picking ;
67:J P[3] 50% CNT100 ;
68: !follow the planned path to pick ;
69:J PR[R[31]] 50% FINE ;
70:J PR[R[32]] 10% FINE ;
71: !add object grasping logic here ;
72: PAUSE ;
73:J PR[R[33]] 50% FINE ;
74: !move to intermediate waypoint ;
75: !of placing ;
76:J P[4] 50% CNT100 ;
77: !move to approach waypoint ;
78: !of placing ;
79:L P[5] 1000mm/sec FINE Tool_Offset,PR[2] ;
80: !move to placing waypoint ;
81:L P[5] 300mm/sec FINE ;
82: !add object releasing logic here, ;
83: !such as "DO[1]=OFF" ;
84: PAUSE ;
85: !move to departure waypoint ;
86: !of placing ;
87:L P[5] 1000mm/sec FINE Tool_Offset,PR[2] ;
88: !move to intermediate waypoint ;
89: !of placing ;
90:J P[4] 50% CNT100 ;
91: ENDFOR ;
92: !finish pick-and-place cycle, and ;
93: !jump back to camera capturing ;
94: JMP LBL[1] ;
95: END ;
96: ;
97: LBL[99:vision error] ;
98: !add error handling logic here ;
99: !according to different ;
100: !error codes ;
101: !e.g.: status=2038 means no ;
102: !point cloud in ROI ;
103: PAUSE ;
위 샘플 프로그램 코드에 해당하는 워크플로는 아래 그림에 표시되어 있습니다.

아래 표는 새롭게 추가된 기능의 설명입니다. 명령어 이름의 링크를 클릭하면 해당 명령의 상세 설명을 확인할 수 있습니다.
워크플로 | 코드와 설명 |
---|---|
계획 경로를 획득하기 |
|
루프를 통해 계획 경로를 저장하기 |
|
R[30] 및 R[31]를 계산하기 |
이 샘플에서는 매번 계획된 피킹 경로에 3개의 경로 웨이포인트가 포함된다고 가정합니다. "R[51] DIV 3"는 R[51]을 3로 나눈 몫을 의미하며, "R[51] MOD 3"는 R[51]을 3로 나눈 나머지를 의미합니다. R[30]은 계획된 피킹의 총 횟수를 의미합니다. R[31] 값이 0이 아닌 경우, 특정 계획된 피킹 웨이포인트 개수가 3개 미만임을 의미하며, 이는 경로 계획에 이상이 발생했음을 나타내므로 다시 계획을 수행해야 합니다. |
경로 계획 오류가 발생했는지 확인하기 |
피킹 횟수 R[30]가 1보다 작은 경우 또는 R[31] 값이 0이 아닌 경우, 경로 계획 중 오류가 발생했음을 의미하며 사용자는 여기에서 코드 처리를 추가해야 합니다. 예를 들어 Mech-Viz 프로젝트를 다시 트리거하여 계획 경로를 획득하는 코드를 추가합니다. |
루프를 통해 피킹 및 배치 작업을 실행하기 |
위의 코드는 FOR 루프 내에서 로봇이 매번 계획된 3개의 웨이포인트로 이동하여 피킹 작업을 수행한 후, 이어서 배치 작업을 실행하는 것을 나타냅니다. R[10]은 순환 횟수를 제어하는 변수로, 1부터 시작하여 매 순환마다 1씩 증가하며, 피킹 횟수 R[30]보다 커지면 루프가 종료됩니다. R[10]이 1 증가할 때마다 R[21]은 3 증가합니다. 또한, 60 + R[21] \~ 62 + R[21] (즉, R[31] ~ R[33])는 매번 계획된 3개의 웨이포인트이 저장될 3개의 레지스터 번호를 나타냅니다. |