1 |
1
이동 로봇(R)을 이동시키는 이동부(110);상기 이동 로봇(R)의 몸체에 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)로 형성된 로봇 암(120);상기 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)을 각각 회전시키는 모터의 회전 수를 기초로 상기 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)의 회전 각도를 각각 측정하는 관절 각도 측정부(200);상기 측정된 제2 및 제3 관절(122, 123)의 회전 각도의 합을 기초로 견인자(U)가 상기 로봇 암(120)을 잡고 이동할 때 상기 로봇(R)의 이동 방향을 예측하고, 상기 측정된 제1 관절(121)의 회전 각도를 기초로 상기 견인자(U)가 상기 로봇 암(120)을 잡고 이동할 때 상기 로봇(R)의 이동 여부를 예측하는 이동 예측부(300); 및상기 예측에 따라 상기 이동부(110)를 제어하는 제어부(400)를 포함하되,상기 이동부(110)는 오른쪽 및 왼쪽 구동 바퀴(112a, 112b)를 포함하고,상기 이동부(110)는 상기 오른쪽 구동 바퀴(112a)의 회전 속도를 상기 왼쪽 구동 바퀴(112b)의 회전 속도보다 크도록 제어하여 상기 이동 로봇(R)을 왼쪽으로 이동시키고,상기 이동부(110)는 상기 왼쪽 구동 바퀴(112b)의 회전 속도를 상기 오른쪽 구동 바퀴(112a)의 회전 속도보다 크도록 제어하여 상기 이동 로봇(R)을 오른쪽으로 이동시키고,상기 제1 관절(121)은 상기 로봇 암(120)의 어깨 올림을 제어하고, 상기 제2 관절(122)은 상기 로봇 암(120)의 어깨 벌림을 제어하고, 상기 제3 관절(123)은 상기 로봇 암(120)의 어깨 돌림을 제어하고, 상기 제4 관절(124)은 상기 로봇 암(120)의 팔꿈치를 제어하고, 상기 제5 관절(125)은 상기 로봇 암(120)의 손목 회전을 제어하고, 상기 제6 관절(126)은 상기 로봇 암(120)의 손목 올림을 제어하고,상기 견인자(U)는 상기 로봇 암(120)의 한 쪽 로봇 암(120)을 잡고 이동하고,상기 제어부(400)는 정지, 전진, 좌회전, 및 우회전 중 어느 하나로 상기 이동부(110)를 제어하는 견인자(U)의 의도를 예측하여 이동하는 이동 로봇(R)
|
2 |
2
삭제
|
3 |
3
삭제
|
4 |
4
이동 로봇(R)을 이동시키는 이동부(110);상기 이동 로봇(R)의 몸체의 좌우에 각각 형성되고, 각각 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)로 구성된 제1 및 제2 로봇 암(120);상기 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)을 각각 회전시키는 모터의 회전 수를 기초로 상기 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)의 회전 각도를 각각 측정하는 관절 각도 측정부(200);상기 측정된 상기 제1 로봇 암(120)의 상기 제2 및 제3 관절(122, 123)의 회전 각도의 합과 상기 측정된 상기 제2 로봇 암(120)의 상기 제2 및 제3 관절(122, 123)의 회전 각도의 합의 차를 기초로 견인자(U)가 상기 제1 및 제2 로봇 암(120)을 잡고 이동할 때 상기 로봇(R)의 이동 방향을 예측하고, 상기 측정된 상기 제1 로봇 암(120)의 상기 제1 관절(121)의 회전 각도 및 상기 측정된 상기 제2 로봇 암(120)의 상기 제1 관절(121)의 회전 각도를 기초로 상기 견인자(U)가 상기 제1 및 제2 로봇 암(120)을 잡고 이동할 때 상기 로봇(R)의 이동 여부를 예측하는 이동 예측부(300); 및상기 예측에 따라 상기 이동부(110)를 제어하는 제어부(400)를 포함하되,상기 이동부(110)는 오른쪽 및 왼쪽 구동 바퀴(112a, 112b)를 포함하고,상기 이동부(110)는 상기 오른쪽 구동 바퀴(112a)의 회전 속도를 상기 왼쪽 구동 바퀴(112b)의 회전 속도보다 크도록 제어하여 상기 이동 로봇(R)을 왼쪽으로 이동시키고,상기 이동부(110)는 상기 왼쪽 구동 바퀴(112b)의 회전 속도를 상기 오른쪽 구동 바퀴(112a)의 회전 속도보다 크도록 제어하여 상기 이동 로봇(R)을 오른쪽으로 이동시키고,상기 제1 관절(121)은 상기 제1 및 제2 로봇 암(120)의 어깨 올림을 제어하고, 상기 제2 관절(122)은 상기 제1 및 제2 로봇 암(120)의 어깨 벌림을 제어하고, 상기 제3 관절(123)은 상기 제1 및 제2 로봇 암(120)의 어깨 돌림을 제어하고, 상기 제4 관절(124)은 상기 제1 및 제2 로봇 암(120)의 팔꿈치를 제어하고, 상기 제5 관절(125)은 상기 제1 및 제2 로봇 암(120)의 손목 회전을 제어하고, 상기 제6 관절(126)은 상기 제1 및 제2 로봇 암(120)의 손목 올림을 제어하고,상기 제어부(400)는 정지, 전진, 좌회전, 및 우회전 중 어느 하나로 상기 이동부(110)를 제어하는 견인자(U)의 의도를 예측하여 이동하는 이동 로봇(R)
|
5 |
5
삭제
|
6 |
6
견인자(U)가 이동 로봇(R)의 몸체(100)에 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)로 형성된 로봇 암(120)을 잡고 이동하는 단계;상기 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)을 각각 회전시키는 모터의 회전 수를 기초로 상기 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)의 회전 각도를 측정하는 단계;상기 측정된 제2 및 제3 관절(122, 123)의 회전 각도의 합을 기초로 상기 이동 로봇(R)의 이동 방향을 예측하고, 상기 측정된 제1 관절(121)의 회전 각도를 기초로 상기 로봇(R)의 이동 여부를 예측하는 단계; 및상기 예측에 따라 상기 로봇(R)의 이동을 제어하는 단계를 포함하되,상기 로봇(R)의 이동을 제어하는 단계는 정지, 전진, 좌회전, 및 우회전 중 어느 하나로 제어하고,상기 제1 관절(121)은 상기 로봇 암(120)의 어깨 올림을 제어하고, 상기 제2 관절(122)은 상기 로봇 암(120)의 어깨 벌림을 제어하고, 상기 제3 관절(123)은 상기 로봇 암(120)의 어깨 돌림을 제어하고, 상기 제4 관절(124)은 상기 로봇 암(120)의 팔꿈치를 제어하고, 상기 제5 관절(125)은 상기 로봇 암(120)의 손목 회전을 제어하고, 상기 제6 관절(126)은 상기 로봇 암(120)의 손목 올림을 제어하고,상기 견인자(U)는 상기 로봇 암(120)의 한 쪽 로봇 암(120)을 잡고 이동하는 견인자(U)의 의도를 예측하여 이동 로봇(R)을 이동시키는 방법
|
7 |
7
삭제
|
8 |
8
삭제
|
9 |
9
견인자(U)가 이동 로봇(R)의 몸체(100)의 좌우에 형성되고 각각 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)로 구성된 제1 및 제2 로봇 암(120)을 잡고 이동하는 단계;상기 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)을 각각 회전시키는 모터의 회전 수를 기초로 상기 제1 내지 제6 관절(121, 122, 123, 124, 125, 126)의 회전 각도를 측정하는 단계;상기 측정된 상기 제1 로봇 암(120)의 상기 제2 및 제3 관절(122, 123)의 회전 각도의 합과 상기 측정된 상기 제2 로봇 암(120)의 상기 제2 및 제3 관절(122, 123)의 회전 각도의 합의 차를 기초로 상기 이동 로봇(R)의 이동 방향을 예측하고, 상기 측정된 상기 제1 로봇 암(120)의 상기 제1 관절(121)의 회전 각도 및 상기 측정된 상기 제2 로봇 암(120)의 상기 제1 관절(121)의 회전 각도를 기초로 상기 로봇(R)의 이동 여부를 예측하는 단계; 및상기 예측에 따라 상기 로봇(R)의 이동을 제어하는 단계를 포함하되,상기 로봇(R)의 이동을 제어하는 단계는 정지, 전진, 좌회전, 및 우회전 중 어느 하나로 제어하고,상기 제1 관절(121)은 상기 제1 및 제2 로봇 암(120)의 어깨 올림을 제어하고, 상기 제2 관절(122)은 상기 제1 및 제2 로봇 암(120)의 어깨 벌림을 제어하고, 상기 제3 관절(123)은 상기 제1 및 제2 로봇 암(120)의 어깨 돌림을 제어하고, 상기 제4 관절(124)은 상기 제1 및 제2 로봇 암(120)의 팔꿈치를 제어하고, 상기 제5 관절(125)은 상기 제1 및 제2 로봇 암(120)의 손목 회전을 제어하고, 상기 제6 관절(126)은 상기 제1 및 제2 로봇 암(120)의 손목 올림을 제어하는 견인자(U)의 의도를 예측하여 이동 로봇(R)을 이동시키는 방법
|
10 |
10
삭제
|