KR100904769B1 - 진로 방해물 감지 장치 및 방법 - Google Patents
진로 방해물 감지 장치 및 방법 Download PDFInfo
- Publication number
- KR100904769B1 KR100904769B1 KR1020080075494A KR20080075494A KR100904769B1 KR 100904769 B1 KR100904769 B1 KR 100904769B1 KR 1020080075494 A KR1020080075494 A KR 1020080075494A KR 20080075494 A KR20080075494 A KR 20080075494A KR 100904769 B1 KR100904769 B1 KR 100904769B1
- Authority
- KR
- South Korea
- Prior art keywords
- value
- distance
- sensor
- corrected
- robot
- Prior art date
Links
- 238000005259 measurement Methods 0.000 claims description 19
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000004519 manufacturing process Methods 0.000 abstract description 3
- 230000000750 progressive Effects 0.000 abstract 1
- 238000001514 detection method Methods 0.000 description 10
- 238000004364 calculation method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000000414 obstructive Effects 0.000 description 3
- 210000001364 Upper Extremity Anatomy 0.000 description 2
- 206010011469 Crying Diseases 0.000 description 1
- HWHLPVGTWGOCJO-UHFFFAOYSA-N Trihexyphenidyl Chemical compound data:image/svg+xml;base64,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 data:image/svg+xml;base64,PD94bWwgdmVyc2lvbj0nMS4wJyBlbmNvZGluZz0naXNvLTg4NTktMSc/Pgo8c3ZnIHZlcnNpb249JzEuMScgYmFzZVByb2ZpbGU9J2Z1bGwnCiAgICAgICAgICAgICAgeG1sbnM9J2h0dHA6Ly93d3cudzMub3JnLzIwMDAvc3ZnJwogICAgICAgICAgICAgICAgICAgICAgeG1sbnM6cmRraXQ9J2h0dHA6Ly93d3cucmRraXQub3JnL3htbCcKICAgICAgICAgICAgICAgICAgICAgIHhtbG5zOnhsaW5rPSdodHRwOi8vd3d3LnczLm9yZy8xOTk5L3hsaW5rJwogICAgICAgICAgICAgICAgICB4bWw6c3BhY2U9J3ByZXNlcnZlJwp3aWR0aD0nODVweCcgaGVpZ2h0PSc4NXB4JyB2aWV3Qm94PScwIDAgODUgODUnPgo8IS0tIEVORCBPRiBIRUFERVIgLS0+CjxyZWN0IHN0eWxlPSdvcGFjaXR5OjEuMDtmaWxsOiNGRkZGRkY7c3Ryb2tlOm5vbmUnIHdpZHRoPSc4NS4wJyBoZWlnaHQ9Jzg1LjAnIHg9JzAuMCcgeT0nMC4wJz4gPC9yZWN0Pgo8cGF0aCBjbGFzcz0nYm9uZC0wIGF0b20tMCBhdG9tLTEnIGQ9J00gMTcuNCw1Ny41IEwgNy4zLDU2LjInIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTIxIGF0b20tNSBhdG9tLTAnIGQ9J00gMjMuNyw0OS40IEwgMTcuNCw1Ny41JyBzdHlsZT0nZmlsbDpub25lO2ZpbGwtcnVsZTpldmVub2RkO3N0cm9rZTojM0I0MTQzO3N0cm9rZS13aWR0aDoxLjBweDtzdHJva2UtbGluZWNhcDpidXR0O3N0cm9rZS1saW5lam9pbjptaXRlcjtzdHJva2Utb3BhY2l0eToxJyAvPgo8cGF0aCBjbGFzcz0nYm9uZC0xIGF0b20tMSBhdG9tLTInIGQ9J00gNy4zLDU2LjIgTCAzLjQsNDYuNycgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtMiBhdG9tLTIgYXRvbS0zJyBkPSdNIDMuNCw0Ni43IEwgOS42LDM4LjYnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTMgYXRvbS0zIGF0b20tNCcgZD0nTSA5LjYsMzguNiBMIDE5LjgsNDAuMCcgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtNCBhdG9tLTQgYXRvbS01JyBkPSdNIDE5LjgsNDAuMCBMIDIzLjcsNDkuNCcgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtNSBhdG9tLTUgYXRvbS02JyBkPSdNIDIzLjcsNDkuNCBMIDMzLjgsNTAuOCcgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtNiBhdG9tLTYgYXRvbS03JyBkPSdNIDMzLjgsNTAuOCBMIDM1LjIsNDAuNicgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtMTIgYXRvbS02IGF0b20tMTMnIGQ9J00gMzMuOCw1MC44IEwgMzMuMyw1NC44JyBzdHlsZT0nZmlsbDpub25lO2ZpbGwtcnVsZTpldmVub2RkO3N0cm9rZTojM0I0MTQzO3N0cm9rZS13aWR0aDoxLjBweDtzdHJva2UtbGluZWNhcDpidXR0O3N0cm9rZS1saW5lam9pbjptaXRlcjtzdHJva2Utb3BhY2l0eToxJyAvPgo8cGF0aCBjbGFzcz0nYm9uZC0xMiBhdG9tLTYgYXRvbS0xMycgZD0nTSAzMy4zLDU0LjggTCAzMi43LDU4LjknIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiNFODQyMzU7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTEzIGF0b20tNiBhdG9tLTE0JyBkPSdNIDMzLjgsNTAuOCBMIDQzLjksNTIuMScgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtNyBhdG9tLTcgYXRvbS04JyBkPSdNIDM1LjIsNDAuNiBMIDQ0LjYsMzYuNycgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtNyBhdG9tLTcgYXRvbS04JyBkPSdNIDM1LjgsMzguMiBMIDQyLjQsMzUuNCcgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtMjIgYXRvbS03IGF0b20tMTInIGQ9J00gMzUuMiw0MC42IEwgMjcuMCwzNC40JyBzdHlsZT0nZmlsbDpub25lO2ZpbGwtcnVsZTpldmVub2RkO3N0cm9rZTojM0I0MTQzO3N0cm9rZS13aWR0aDoxLjBweDtzdHJva2UtbGluZWNhcDpidXR0O3N0cm9rZS1saW5lam9pbjptaXRlcjtzdHJva2Utb3BhY2l0eToxJyAvPgo8cGF0aCBjbGFzcz0nYm9uZC04IGF0b20tOCBhdG9tLTknIGQ9J00gNDQuNiwzNi43IEwgNDYuMCwyNi42JyBzdHlsZT0nZmlsbDpub25lO2ZpbGwtcnVsZTpldmVub2RkO3N0cm9rZTojM0I0MTQzO3N0cm9rZS13aWR0aDoxLjBweDtzdHJva2UtbGluZWNhcDpidXR0O3N0cm9rZS1saW5lam9pbjptaXRlcjtzdHJva2Utb3BhY2l0eToxJyAvPgo8cGF0aCBjbGFzcz0nYm9uZC05IGF0b20tOSBhdG9tLTEwJyBkPSdNIDQ2LjAsMjYuNiBMIDM3LjksMjAuMycgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MS4wcHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtOSBhdG9tLTkgYXRvbS0xMCcgZD0nTSA0My41LDI3LjMgTCAzNy44LDIyLjknIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTEwIGF0b20tMTAgYXRvbS0xMScgZD0nTSAzNy45LDIwLjMgTCAyOC40LDI0LjInIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTExIGF0b20tMTEgYXRvbS0xMicgZD0nTSAyOC40LDI0LjIgTCAyNy4wLDM0LjQnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTExIGF0b20tMTEgYXRvbS0xMicgZD0nTSAzMC4yLDI2LjAgTCAyOS4zLDMzLjEnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTE0IGF0b20tMTQgYXRvbS0xNScgZD0nTSA0My45LDUyLjEgTCA1MC4yLDQ0LjAnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTE1IGF0b20tMTUgYXRvbS0xNicgZD0nTSA1MC4yLDQ0LjAgTCA1NC4yLDQ0LjYnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTE1IGF0b20tMTUgYXRvbS0xNicgZD0nTSA1NC4yLDQ0LjYgTCA1OC4zLDQ1LjEnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiM0Mjg0RjQ7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTE2IGF0b20tMTYgYXRvbS0xNycgZD0nTSA2MS43LDQ4LjYgTCA2My4wLDUxLjcnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiM0Mjg0RjQ7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTE2IGF0b20tMTYgYXRvbS0xNycgZD0nTSA2My4wLDUxLjcgTCA2NC4yLDU0LjgnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTIzIGF0b20tMjEgYXRvbS0xNicgZD0nTSA2Ni42LDM3LjMgTCA2NC4zLDQwLjMnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTIzIGF0b20tMjEgYXRvbS0xNicgZD0nTSA2NC4zLDQwLjMgTCA2MS45LDQzLjMnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiM0Mjg0RjQ7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTE3IGF0b20tMTcgYXRvbS0xOCcgZD0nTSA2NC4yLDU0LjggTCA3NC40LDU2LjInIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTE4IGF0b20tMTggYXRvbS0xOScgZD0nTSA3NC40LDU2LjIgTCA4MC42LDQ4LjEnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTE5IGF0b20tMTkgYXRvbS0yMCcgZD0nTSA4MC42LDQ4LjEgTCA3Ni43LDM4LjYnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTIwIGF0b20tMjAgYXRvbS0yMScgZD0nTSA3Ni43LDM4LjYgTCA2Ni42LDM3LjMnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjEuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+Cjx0ZXh0IHg9JzMwLjYnIHk9JzYzLjknIGNsYXNzPSdhdG9tLTEzJyBzdHlsZT0nZm9udC1zaXplOjZweDtmb250LXN0eWxlOm5vcm1hbDtmb250LXdlaWdodDpub3JtYWw7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOm5vbmU7Zm9udC1mYW1pbHk6c2Fucy1zZXJpZjt0ZXh0LWFuY2hvcjpzdGFydDtmaWxsOiNFODQyMzUnID5PPC90ZXh0Pgo8dGV4dCB4PSczNC44JyB5PSc2My45JyBjbGFzcz0nYXRvbS0xMycgc3R5bGU9J2ZvbnQtc2l6ZTo2cHg7Zm9udC1zdHlsZTpub3JtYWw7Zm9udC13ZWlnaHQ6bm9ybWFsO2ZpbGwtb3BhY2l0eToxO3N0cm9rZTpub25lO2ZvbnQtZmFtaWx5OnNhbnMtc2VyaWY7dGV4dC1hbmNob3I6c3RhcnQ7ZmlsbDojRTg0MjM1JyA+SDwvdGV4dD4KPHRleHQgeD0nNTguNScgeT0nNDguNCcgY2xhc3M9J2F0b20tMTYnIHN0eWxlPSdmb250LXNpemU6NnB4O2ZvbnQtc3R5bGU6bm9ybWFsO2ZvbnQtd2VpZ2h0Om5vcm1hbDtmaWxsLW9wYWNpdHk6MTtzdHJva2U6bm9uZTtmb250LWZhbWlseTpzYW5zLXNlcmlmO3RleHQtYW5jaG9yOnN0YXJ0O2ZpbGw6IzQyODRGNCcgPk48L3RleHQ+Cjwvc3ZnPgo= C1CCCCC1C(C=1C=CC=CC=1)(O)CCN1CCCCC1 HWHLPVGTWGOCJO-UHFFFAOYSA-N 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006011 modification reaction Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0227—Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
Abstract
본 발명은 진로 방해물 감지 장치 및 방법에 관한 것으로, 더욱 상세하게는 단일의 거리감지 센서 및/또는 기울기 측정 센서를 활용하여 전방의 장애물과 낭떠러지 등의 진로 방해물을 감지할 수 있는 진로 방해물 감지 장치 및 방법에 관한 것이다.
장애물, 낭떠러지, 거리감지 센서, 기울기 측정 센서
Description
본 발명은 진로 방해물 감지 장치 및 방법에 관한 것으로, 더욱 상세하게는 단일의 거리감지 센서 및/또는 기울기 측정 센서를 활용하여 전방의 장애물과 낭떠러지 등의 진로 방해물을 감지할 수 있는 진로 방해물 감지 장치 및 방법에 관한 것이다.
본 발명은 관절 로봇용 완구 또는 관절 로봇에 장착되어 진로에 방해가 되는 전방의 장애물(ex, 벽)이나 낭떠러지를 자동으로 감지하기 위한 용도로 적용된다.
종래의 로봇용 완구는 관절 등을 이용하여 이동이 가능하며 전방의 장애물이나 낭떠러지를 자동으로 감지하여 진로를 변경할 수 있는 장치가 상기 로봇용 완구 내에 장착된다.
도 1은 종래의 진로 방해물 감지 장치가 장착된 완구를 도시한 것이다.
종래의 진로 방해물 감지 장치는 도 1의 (가)와 같이 거리감지 센서를 이용 하고 단일 방향으로 측정된 값을 통해 하나의 거리를 산출하는 방식이 사용되고 있다.
보다 구체적으로 전방의 장애물을 감지하기 위해 수평방향으로 설치된 제 1 거리 감지 센서를 이용하여 수평거리(A)를 산출하고, 낭떠러지를 감지하기 위해 수직방향으로 설치된 제 2 거리 감지 센서를 이용하여 수직거리(B)를 산출하여 진로 방해물을 감지하는 방식이다.
또한, 도 1의 (나)와 같이 구동축의 종단에 거리감지 센서를 장착하고 원하는 방향의 거리를 측정하기 위해 구동부위를 움직이는 방식이 사용되고 있다.
그러나 전자의 방식은 다양한 방향의 거리를 측정하기 위해서는 센서가 각각 부착되어야 하므로 제조 단가가 상승하고, 장착되는 로봇의 크기가 커지는 문제가 발생한다. 또한, 거리 측정 센서를 케이스 외관에 노출하거나 빛이 발광/수광할 수 있도록 만들어야 하므로 로봇 디자인 상에 제약이 되는 문제가 있었다.
그리고 후자의 방식 또한 구동축을 사용하여야 하므로 단가가 상승하고 로봇의 크기가 커지는 문제가 있었다.
상기와 같은 문제점을 해결하기 위해 안출된 것으로써 본 발명의 목적은 단일의 거리 감지 센서 및/또는 기울기 측정 센서를 활용하여 낭떠러지, 전방 장애물 등의 진행 방해물을 감지할 수 있는 장치를 제공하는 데 있다.
상기와 같은 목적을 달성하기 위해 본 발명에 따른 진행 방해물 감지 장치는 로봇으로부터 일정한 각도를 가지고 하부를 향하도록 비스듬히 부착되어 진행방향의 하부로 향하는 사선에 위치하는 지면까지의 거리를 측정하는 거리 감지 센서와 지면 사이의 사선 거리 기준값(X)을 산출하여 저장하고, 상기 로봇의 동작에 따라 상기 거리 감지 센서로부터 측정된 값(Xsensor)과 기준값(X)을 비교하여 진행 방해물을 감지하는 제어부를 포함하는 것을 특징으로 한다.
이하, 관절로봇, 관절 로봇용 완구 등 자동 또는 수동 제어에 의해 스스로 이동 가능한 모든 종류의 기계를 로봇이라 통칭하기로 한다.
여기서, 상기 제어부는 기울기 변화가 없는 경우 거리 감지 센서로부터 지면까지 수직거리(L)와 상기 거리 감지 센서의 경사각도(θ)로부터 사선 거리 기준값(X)을 산출하여 저장하고, 상기 로봇의 동작에 따라 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 기준값(X)과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X) 보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X)보다 작으면 장애물로 판단하는 것을 특징으로 한다.
또한, 로봇의 이동 및 동작시 수평축으로부터 기울기를 측정하는 기울기 측정 센서를 더 포함하는 것을 특징으로 한다.
여기서, 상기 기울기 측정 센서는 기울기 센서, 가속도 센서 및 자이로 센서 중 선택된 어느 하나인 것을 특징으로 한다.
이때, 상기 제어부는 상기 기울기 측정 센서를 포함하지 않은 상태에서 상기 로봇의 동작시 기울기 변화를 감지할 경우 상기 로봇의 자세(관절각도) 변화로부터 기구학적으로 기울어진 각도(α)를 산출하고 상기 기울어진 각도(α)에 따라 보정된 기준값(X')을 산출하되, 구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 이용하여 거리 감지 센서로부터 지면 까지의 거리(L')를 산출하고, 상기 산출된 L'값으로부터 보정된 기준값(X')을 산출하여 저장하고, 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 보정된 기준값(X')과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 보정된 기준값(X') 보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 보정된 기준값(X')보다 작으면 장애물로 판단하는 것을 특징으로 한다.
그리고 상기 기울기 측정 센서를 포함하여 상기 기울기 측정 센서가 기울기 변화를 감지할 경우 감지된 기울기 각도(α)에 따라 보정된 기준값(X')을 산출하되, 구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 이용하여 거리 감지 센서로부터 지면까지의 거리(L')을 산출 하고, 상기 산출된 L'값으로부터 보정된 기준값(X')을 산출하여 저장하고, 로봇의 동작시 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 기준값(X')과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X') 보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X')보다 작으면 장애물로 판단하는 것을 특징으로 한다.
또한, 상기 제어부는 상기 측정된 값(Xsensor)이 상기 보정된 기준값(X')보다 작아서 장애물로 판단하는 경우 상기 측정된 값(Xsensor)와 상기 기울기 각도(α)과 상기 거리 감지 센서의 경사각도(θ)를 이용하여 장애물까지의 상대거리(Y)를 추출하는 것을 특징으로 한다.
한편, 본 발명에 따른 진행 방해물 감지 방법은 (a) 진행 방해물이 없는 상태에서 로봇으로부터 일정한 각도를 가지고 하부를 향하도록 비스듬히 부착되어 진행방향의 하부로 향하는 사선에 위치하는 지면까지의 사선 거리 기준값(X)을 산출하여 저장하는 단계와 (b) 상기 거리 감지 센서가 지면까지의 사선 거리 측정값(Xsensor)을 생성하는 단계와 (c) 감지모듈이 상기 기준값(X)과 측정 값(Xsensor)을 비교하여 진행 방해물을 감지하는 단계를 포함하는 것을 특징으로 한다.
여기서, 상기 (a) 단계는 기울기 변화가 없는 경우 거리 감지 센서로부터 지면까지의 수직 거리(L)와 상기 거리 감지 센서의 경사각도(θ)로부터 지면까지 사선 거리 기준값(X)을 산출하여 저장하는 것을 특징으로 한다.
그리고 상기 (a) 단계는 기울기 측정 센서가 없는 경우, 상기 로봇의 동작시기 울기 변화가 있는 경우 제어부가 상기 로봇의 자세(관절각도)의 변화로부터 기구학적으로 기울어진 각도(α)를 산출하고 상기 기울어진 각도(α)에 따라 보정된 기준 값(X')을 산출하되, 구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 이용하여 거리 감지 센서로부터 지면까지의 거리(L')를 산출하고, 상기 산출된 L'값으로부터 보정된 기준값(X')을 산출하는 것을 특징으로 한다.
또한, 상기 (a) 단계는 기울기 측정 센서를 포함하여 구성되는 경우 상기 기울기 측정 센서가 기울기를 감지하여 감지된 기울기 각도(α)에 따라 보정된 기준값(X')을 산출하되, 구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 이용하여 거리 감지 센서로부터 지면까지의 거리(L')을 산출하고, 상기 산출된 L'값으로부터 보정된 기준값(X')을 산출하여 저장하는 것을 특징으로 한다.
또한, 상기 (c) 단계는 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 기준값(X) 또는 보정된 기준값(X')과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X) 또는 보정된 기준값(X') 보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X) 또는 보정된 기준값(X')보다 작으면 장애물로 판단하는 것을 특징으로 한다.
상기에서 살펴본 바와 같이 본 발명에 따른 진행 방해물 감지 장치는 단일의 거리 감지 센서 또는 단일의 거리 감지 센서와 기울기 측정 센서를 이용하여 관절 로봇의 작동이나 이동시 전방의 낭떠러지 또는 전방 장애물 등의 진행 방해물을 감 지할 수 있으므로 생산 단가를 낮출 수 있으며, 센서가 외부로 노출되는 면적이 작아서 로봇 디자인 상에 제약을 제거할 수 있는 탁월한 효과가 발생한다.
이하, 본 발명의 구체적인 실시예를 도면을 참조하여 상세하게 설명하기로 한다.
도 2는 본 발명의 바람직한 실시예에 따른 진행 방해물 감지 장치의 구성도이고, 도 3은 본 발명의 바람직한 실시예에 따른 진행 방해물 감지 장치가 부착된 각식 로봇을 도시한 것이다.
도 2 및 3을 참조하면, 본 발명에 따른 진행 방해물 감지 장치는 로봇 전단에 로봇으로부터 일정한 각도를 가지고 하부를 향하도록 비스듬히 부착되어 진행방향의 하부로 향하는 사선에 위치하는 지면까지의 거리를 측정하는 거리 감지 센서(20)와 진행 방해물이 없는 거리 감지 센서와 지면 사이의 사선 거리 기준값(X)을 산출하여 저장하고, 상기 거리 감지 센서로부터 측정된 값(Xsensor)과 기준값(X)을 비교하여 진행 방해물을 감지하는 제어부(10)를 포함하여 구성될 수 있다.
여기서, 상기 진행방향에 위치하는 낭떠러지나 장애물을 총칭하여 진행 방해물이라 정의하기로 한다.
상기 거리 감지 센서(20)와 제어부(10)는 원 칩(one chip)으로 구성될 수 있으며, 별도로 구성되어 유선 또는 무선으로 데이터를 송신하는 방식으로 구성될 수 있다.
상기 거리 감지 센서(20)는 로봇에서 하부 사선 방향의 지면 또는 방해물까지의 거리를 측정할 수 있도록 설치될 수 있다. 여기서, 상기 거리 감지 센서는 전단 또는 측면 등 진행방향을 감지할 수 있기만 하면 지면으로부터 일정높이를 가진 어떤 위치에도 형성될 수 있으며, 구동축 중심의 높이(H)와 같은 높이에 형성될 수도 있다. 여기서, 상기 거리 감지 센서(20)는 PSD센서, 적외선 센서, 레이저 센서 등 거리를 감지할 수 있는 센서는 무엇이나 사용 가능하다.
그리고 상기 거리 감지 센서의 경사각도(θ)는 임의대로 결정할 수 있으나, 각도가 지나치게 크거나 작을 경우 정확한 센싱이 어려울 수 있으므로 30 ~ 60도 사이에서 설정하는 것이 바람직하다.
상기 거리 감지 센서로부터 지면까지 수직거리(L)와 지면으로부터 구동축 중심까지의 거리(H)가 동일하고 기울기 변화가 없는 경우에는 상기 제어부(10)는 거리 감지 센서로부터 지면까지 수직거리(L)는 H와 동일하므로 L의 크기를 알 수 있으며, 수학식 X = L/ sinθ를 이용하여 기준값(X)을 산출하여 저장하고, 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 기준값(X)과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X)보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X)보다 작으면 장애물로 판단할 수 있다.
상기 지면으로부터 구동축 중심까지의 거리(H)는 기울기 변화가 없는 경우 로봇의 다리 높이와 같으며, 각식 로봇의 경우 H는 지면과 접촉하는 다리의 높이를 측정함으로써 구할 수 있으며, 로봇의 구성에 따라 H를 구하는 방법이 달라질 수 있다.
여기서, 상기 측정된 값(Xsensor)이 상기 기준값(X)보다 작아서 장애물로 판단하는 경우 상기 측정된 값(Xsensor)와 상기 거리 감지 센서의 경사각도(θ)를 이용하여 장애물까지의 상대거리(Y, Y=Xsensor×Cosθ)를 추출할 수 있다.
그리고 로봇의 이동이나 동작으로 구동축의 기울기가 변할 경우 기준값(X)이 변하므로 기울기 각도에 따라 기준값을 보정할 필요가 있으며, 로봇의 이동이나 동작시 다리높이가 변하는 경우 로봇의 관절 각도 변화로부터 다리 높이 변화를 알 수 있으며, 상기 변화된 다리 높이와 지면에서 구동축 까지의 거리(H) 관계로부터 기울어진 정도를 산출할 수 있으며, 상기 산출된 기울기 각도(α)를 반영하여 기준값(X)을 보정할 수 있다.
결국, 로봇의 자세 변화에 따른 관절 각도의 변화로부터 기구학적으로 지면과 로봇 또는 로봇용 완구의 기울어진 각도(α)를 계산할 수 있다.
상기 지면과 로봇 또는 로봇용 완구의 기울기 각도(α)의 변화에 따라 보정된 기준값(X')을 산출할 수 있다.
도 4는 본 발명의 바람직한 실시예에 따른 기구학적으로 기울어진 각도를 산출하는 것을 도시한 것이다.
도 4를 참조하면, 로봇 기준 좌표계(OR)는 기울어진 상태를 기준으로 앞다리와 뒷다리의 좌표를 알 수 있으며, 앞다리와 뒷다리의 좌표는 (Xf, Yf), (Xr, Yr)이므로 기울어진 각도(α)는 atan(ΔY/ΔX)로부터 산출할 수 있다.
여기서, 기울기 각도(α)만 결정되면 보정된 기준값(X') 산출은 하기에 설명할 기울기 측정 센서를 포함하는 경우의 산출방법과 동일하므로 구체적인 방법은 생략하기로 한다.
도 5는 본 발명의 바람직한 실시예에 따른 기울기 측정 센서를 포함하는 진행 방해물 감지장치가 장착된 각식 로봇을 도시한 것이다.
도 5를 참조하면, 진행 방해물 감지장치는 기울기 측정 센서(30)를 더 포함하여 구성될 수 있으며, 상기 기울기 측정 센서(30)는 기울기 측정이 가능한 기울기 센서, 가속도 센서 또는 자이로 센서가 사용될 수 있다.
그리고 상기 기울기 측정 센서(30)는 기울기 변화를 측정하므로 로봇의 어떠한 위치에도 부착될 수 있다.
본원발명은 상기에서 설명한 바와 같이 기울기 측정 센서(30) 없이 거리 감지 센서(20) 만으로 진행 방해물을 감지할 수 있으나, 센싱의 정확도를 높이기 위해 기울기 측정 센서(30)를 포함하여 구성하는 것이 바람직하다.
도 6은 본 발명의 거리 감지 센서로부터 지면까지의 거리(X) 산출을 위한 모식도를 도시한 것이다.
도 6을 참조하면, 각식 로봇의 구조에서 보행을 위한 다리는 최소 3축의 Manupulator로 생각할 수 있으며, 하기와 같은 수식은 이를 간단히 표기한 내용이다.
즉 이동을 목적으로 한 다리와 기울기 측정 센서를 통해 지면에서 거리 감지 센서(20)까지의 변환 행렬을 구할 수 있으며 이를 통해서 전방 장애물이나 낭떠러지가 없을 경우 거리 감지 센서로부터 지면까지의 거리(X')를 산출할 수 있다. 여기서 산출된 거리 감지 센서로부터 지면까지의 거리와 실제 센서값(Xsensor)을 비교함으로써 장애물과 낭떠러지를 구분할 수 있다.
보다 구체적으로, 상기 제어부(10)는 상기 기울기 측정 센서(30)가 기울기를 감지할 경우 감지된 기울기 각도(α)에 따라 보정된 기준값(X)을 산출하되, 구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 이용하여 거리 감지 센서로부터 지면까지의 거리(L, L = H + Osinα)를 산출하고, 상기 산출된 L 값으로부터 수학식 X = L/ sin(θ-α)를 이용하여 보정된 기준값(X')을 산출하여 저장하고, 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 기준값(X')과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X') 보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X')보다 작으면 장애물로 판단한다. 상기 측정된 값(Xsensor)이 상기 기준값(X')보다 작아서 장애물로 판단하는 경우 상기 측정된 값(Xsensor)와 상기 기울기 각도(α)과 상기 거리 감지 센서의 경사각도(θ)를 이 용하여 장애물까지의 상대거리[Y, Y=Xsensor×Cos(θ-α)]를 추출할 수 있다.
상기 제어부(10)는 각종 변수 및 산출된 X 또는 X' 값을 저장하는 메모리(120)와 상기 메모리에 저장된 X 또는 X' 값과 거리 감지 센서로부터 측정된 Xsensor 값을 비교하여 낭떠러지 및 전방 장애물을 판단하는 감지모듈(110)을 포함하여 구성될 수 있다.
여기서, 상기 각종 변수는 지면으로부터 구동축 중심의 높이(H), 로봇의 작동이나 이동시 로봇 다리의 관절 변화에 따른 구동축 중심의 높이(△H) 변화 값과 거리 감지 센서의 지면까지의 수직거리(L), 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 포함할 수 있다.
이하, 본 발명의 진행 방해물 감지 방법에 대해 살펴보기로 한다.
도 7은 본 발명의 바람직한 실시예에 따른 진행 방해물 감지 방법을 개략적으로 도시한 순서도이다.
도 7을 참조하면, 먼저 지면까지의 수직 거리(L)로부터 로봇 또는 로봇 완구의 지면까지 사선 거리 기준값(X)을 산출하여 저장한다.(S110)
여기서, 기울기 변화가 없는 경우 지면으로부터 구동축 중심까지의 거리(H)와 거리 감지 센서로부터 지면까지의 수직 거리(L)가 동일하여 L크기를 알 수 있으며 수학식 X = L/ sinθ를 이용하여 로봇으로부터 지면까지 사선 거리 기준값(X)을 산출하여 저장한다. 상기 H값은 로봇의 종류와 크기에 따라 다르게 결정될 수 있으며 미리 결정되어 저장되는 값이다.
만일, 기울기 변화가 있다면 로봇의 다리높이가 변화하므로 L값이 변화된 다. 여기서, 기울기 측정 센서가 없는 경우 다리높이의 굽힘 정도(관절각도)에 따라 변화되는 다리높이를 알 수 있으며, 상기 변화된 다리 높이와 H값을 이용하여 기울기 각도(α)를 결정할 수 있다.
한편, 기울기 측정 센서를 포함하는 경우 상기 기울기 측정 센서가 기울기 변화를 감지하여 기울기 각도(α)를 실시간으로 판단할 수 있다. 여기서, 기울기 측정 센서가 없는 경우에도 로봇의 이동이나 동작시 기울기를 알 수 있으나, 이는 유추를 통해 산출된 수치이므로 정확성이 떨어질 수 있으므로 기울기 측정 센서를 포함하여 구성하는 것이 바람직하다.
상기와 같이 기울기 각도(α)가 있는 경우 이에 따라 보정된 기준값(X')을 산출하되, 구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 이용하여 거리 감지 센서로부터 지면까지의 거리(L, L = H + Osinα)을 산출하고, 상기 산출된 L 값으로부터 수학식 X = L/ sin(θ-α)를 이용하여 보정된 기준값(X')을 산출하여 저장한다.
다음으로, 거리 감지 센서가 지면까지의 사선 거리를 측정(Xsensor)한다. (S120).
그 후, 감지모듈이 상기 기준값(X) 또는 기울기가 변화가 있는 경우 보정된 기준값(X')와 측정 값(Xsensor)을 비교하여 진행 방해물을 감지한다.(S130)
보다 구체적으로, 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 기준값(X) 또는 기울기가 있는 경우 보정된 기준값(X')과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X) 또는 기울기 변화가 있는 경우 보정된 기준값(X') 보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X) 또는 기울기 변화가 있는 경우 보정된 기준값(X')보다 작으면 장애물로 판단한다. 이를 통해 낭떠러지, 장애물 등의 진행 방해물을 정확하게 감지할 수 있다.
이상에서 설명한 본 발명의 상세한 설명에서는 본 발명의 바람직한 실시예를 참조하여 설명하였지만, 본 발명의 보호범위는 상기 실시예에 한정되는 것이 아니며, 해당 기술분야의 통상의 지식을 갖는 자라면 본 발명의 사상 및 기술영역으로부터 벗어나지 않는 범위 내에서 본 발명을 다양하게 수정 및 변경시킬 수 있음을 이해할 수 있을 것이다.
도 1은 종래의 진로 방해물 감지 장치가 장착된 완구를 도시한 것이다.
도 2는 본 발명의 바람직한 실시예에 따른 진행 방해물 감지 장치의 구성도이고, 도 3은 본 발명의 바람직한 실시예에 따른 진행 방해물 감지 장치가 부착된 각식 로봇을 도시한 것이다.
도 4는 본 발명의 바람직한 실시예에 따른 기구학적으로 기울어진 각도를 산출하는 것을 도시한 것이다.
도 5는 본 발명의 바람직한 실시예에 따른 기울기 측정 센서를 포함하는 진행 방해물 감지장치가 장착된 각식 로봇을 도시한 것이다.
도 6은 본 발명의 거리 감지 센서로부터 지면까지의 거리(X) 산출을 위한 모식도를 도시한 것이다.
도 7은 본 발명의 바람직한 실시예에 따른 진행 방해물 감지 방법을 개략적으로 도시한 순서도이다.
Claims (13)
- 관절 로봇으로부터 일정한 각도를 가지고 하부를 향하도록 비스듬히 부착되어 진행방향의 하부로 향하는 사선에 위치하는 지면까지의 거리를 측정하는 거리 감지 센서(20)와; 진행 방해물이 없는 상태에서 상기 거리 감지 센서와 지면까지의 사이의 사선 거리 기준값(X)을 산출하여 저장하고, 로봇의 동작에 따라 상기 거리 감지 센서로부터 측정된 값(Xsensor)과 기준값(X)을 비교하여 진행 방해물을 감지하는 제어부(10)를 포함하되;상기 제어부(10)는상기 관절 로봇의 동작시 기울기 변화가 있는 경우 상기 로봇의 자세(관절각도)변화로부터 기구학적으로 기울어진 각도(α)에 따라 보정된 기준값(X')을 산출하여 상기 관절 로봇의 동작에 따라 상기 거리 감지 센서로부터 측정된 값(Xsensor)과 상기 보정된 기준값(X')을 비교하여 진행방해물을 감지하는 것을 특징으로 하는 진행 방해물 감지 장치.
- 제 1항에 있어서,상기 제어부(10)는상기 관절 로봇의 동작시 기울기 변화가 있는 경우구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 이용하여 거리 감지 센서(20)로부터 지면까지의 거리(L')를 산출하여 상기 산출된 L'값으로부터 보정된 기준값(X')을 산출하여 저장하고,상기 로봇의 동작에 따라 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 보정된 기준값(X')과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 보정된 기준값(X')보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 보정된 기준값(X')보다 작으면 장애물로 판단하는 것을 특징으로 하는 진행 방해물 감지 장치.
- 삭제
- 제 1항에 있어서,상기 로봇의 동작시 기울기 변화가 있는 경우 상기 관절 로봇의 기울어진 각도(α)를 측정하는 기울기 측정 센서(30)를 더 포함하는 것을 특징으로 하는 진행 방해물 감지 장치.
- 제 4항에 있어서,상기 기울기 측정 센서(30)는기울기 센서, 가속도 센서 및 자이로 센서 중 선택된 어느 하나인 것을 특징으로 하는 진행 방해물 감지 장치.
- 삭제
- 제 4항에 있어서,상기 제어부(10)는상기 기울기 측정 센서(30)가 기울기 변화를 감지할 경우 감지된 기울기 각도(α)에 따라 보정된 기준값(X')을 산출하되,구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서 사이의 거리(O)를 이용하여 거리 감지 센서(20)로부터 지면까지의 거리(L')을 산출하고,상기 산출된 L'값으로부터 보정된 기준값(X')을 산출하여 저장하고,로봇의 동작시 상기 거리 감지 센서로부터 측정된 값(Xsensor)이 상기 보정된 기준값(X')과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 보정된 기준값(X') 보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 보정된 기준값(X')보다 작으면 장애물로 판단하는 것을 특징으로 하는 진행 방해물 감지 장치.
- 제 7항에 있어서,상기 제어부(10)는상기 측정된 값(Xsensor)이 상기 보정된 기준값(X')보다 작아서 장애물로 판단하는 경우 상기 측정된 값(Xsensor)와 상기 기울기 각도(α)와 상기 거리 감지 센서(20)의 경사각도(θ)를 이용하여 장애물까지의 상대거리(Y)를 추출하는 것을 특징으로 하는 진행 방해물 감지 장치.
- (a) 관절 로봇 동작시 기울기 변화가 없는 경우 제어부(10)가 진행 방해물이 없는 상태에서 관절 로봇으로부터 일정한 각도를 가지고 하부를 향하도록 비스듬히 장착된 거리 감지 센서(20)로부터 지면까지 사선 거리 기준값(X)을 산출하여 저장하고,상기 관절 로봇 동작시 기울기 변화가 있는 경우 상기 제어부(10)가 상기 로봇의 자세(관절각도) 변화로부터 기구학적으로 기울어진 각도(α)를 산출하고 상기 기울어진 각도(α)에 따라 보정된 기준값(X')을 산출하는 단계;(b) 관절 로봇의 동작에 따라 상기 거리 감지 센서가 지면 또는 물체까지의 사선 거리 측정값(Xsensor)을 생성하는 단계와;(c) 상기 제어부(10)가 기울기가 변화가 없는 경우 상기 기준값(X)와 측정값(Xsensor)를 비교하고, 기울기 변화가 있는 경우 상기 보정된 기준값(X')과 측정값(Xsensor)을 비교하여 진행방해물을 감지하는 단계를 포함하는 진행 방해물 감지 방법.
- 제 9항에 있어서,상기 (a) 단계는상기 관절 로봇의 동작시 기울기 변화가 있는 경우 제어부(10)가 상기 로봇의 자세(관절각도) 변화로부터 기구학적으로 기울어진 각도(α)를 산출하고 상기 기울어진 각도(α)에 따라 보정된 기준값(X')을 산출하되,구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서(20) 사이의 거리(O)를 이용하여 거리 감지 센서로부터 지면까지의 거리(L')을 산출하고, 상기 산출된 L'값으로부터 보정된 기준값(X')을 산출하는 것을 특징으로 하는 진행 방해물 감지 방법.
- 삭제
- 제 9항에 있어서,상기 (a) 단계는기울기 측정 센서(30)가 기울기를 감지할 경우 감지된 기울기 각도(α)에 따라 보정된 기준값(X')을 산출하되,구동 중심점으로부터 지면까지의 거리(H)와 상기 구동 중심점과 거리 감지 센서(20) 사이의 거리(O)를 이용하여 거리 감지 센서로부터 지면까지의 거리(L')를 산출하고,상기 산출된 L'값으로부터 보정된 기준값(X')을 산출하여 저장하는 것을 특징으로 하는 진행 방해물 감지 방법.
- 제 9항에 있어서,상기 (c) 단계는상기 거리 감지 센서(20)로부터 측정된 값(Xsensor)이 상기 보정된 기준값(X')과 같으면 진행 방해물이 없다고 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X) 또는 보정된 기준값(X') 보다 크면 낭떠러지로 판단하고, 상기 측정된 값(Xsensor)이 상기 기준값(X) 또는 보정된 기준값(X')보다 작으면 장애물로 판단하는 것을 특징으로 하는 진행 방해물 감지 방법.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020080075494A KR100904769B1 (ko) | 2008-08-01 | 2008-08-01 | 진로 방해물 감지 장치 및 방법 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020080075494A KR100904769B1 (ko) | 2008-08-01 | 2008-08-01 | 진로 방해물 감지 장치 및 방법 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| KR100904769B1 true KR100904769B1 (ko) | 2009-06-25 |
Family
ID=40983198
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| KR1020080075494A KR100904769B1 (ko) | 2008-08-01 | 2008-08-01 | 진로 방해물 감지 장치 및 방법 |
Country Status (1)
| Country | Link |
|---|---|
| KR (1) | KR100904769B1 (ko) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2016224619A (ja) * | 2015-05-28 | 2016-12-28 | シャープ株式会社 | 事故防止装置およびこれを備えた携帯用電子機器 |
| CN108873878A (zh) * | 2017-06-22 | 2018-11-23 | 北京石头世纪科技有限公司 | 自主机器人及其控制方法、装置、系统和计算机可读介质 |
| KR101945116B1 (ko) * | 2017-08-07 | 2019-02-01 | 이은경 | 이동 단말기 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2006146376A (ja) * | 2004-11-17 | 2006-06-08 | Mitsubishi Heavy Ind Ltd | 自立移動ロボット及び移動不能領域検出方法 |
| JP2006190105A (ja) | 2005-01-06 | 2006-07-20 | Toshiba Corp | 移動ロボット |
| KR100638220B1 (ko) | 2005-04-23 | 2006-10-27 | 엘지전자 주식회사 | 주행로봇의 위치감지장치 및 그를 구비한 로봇청소기 |
| JP2008020370A (ja) | 2006-07-13 | 2008-01-31 | Toyota Motor Corp | 自律移動装置 |
-
2008
- 2008-08-01 KR KR1020080075494A patent/KR100904769B1/ko active IP Right Grant
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2006146376A (ja) * | 2004-11-17 | 2006-06-08 | Mitsubishi Heavy Ind Ltd | 自立移動ロボット及び移動不能領域検出方法 |
| JP2006190105A (ja) | 2005-01-06 | 2006-07-20 | Toshiba Corp | 移動ロボット |
| KR100638220B1 (ko) | 2005-04-23 | 2006-10-27 | 엘지전자 주식회사 | 주행로봇의 위치감지장치 및 그를 구비한 로봇청소기 |
| JP2008020370A (ja) | 2006-07-13 | 2008-01-31 | Toyota Motor Corp | 自律移動装置 |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2016224619A (ja) * | 2015-05-28 | 2016-12-28 | シャープ株式会社 | 事故防止装置およびこれを備えた携帯用電子機器 |
| CN108873878A (zh) * | 2017-06-22 | 2018-11-23 | 北京石头世纪科技有限公司 | 自主机器人及其控制方法、装置、系统和计算机可读介质 |
| KR101945116B1 (ko) * | 2017-08-07 | 2019-02-01 | 이은경 | 이동 단말기 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4788722B2 (ja) | 自律移動ロボット、自己位置推定方法、環境地図の生成方法、環境地図の生成装置、及び環境地図のデータ構造 | |
| US8019475B2 (en) | Routing apparatus for autonomous mobile unit | |
| CN106489104A (zh) | 用于移动机器人中的光学量程传感器的使用的系统和方法 | |
| KR100772912B1 (ko) | 절대 방위각을 이용한 로봇 및 이를 이용한 맵 작성 방법 | |
| KR101985188B1 (ko) | 이동 로봇 및 이동 로봇의 주행방법 | |
| JP5278283B2 (ja) | 自律移動装置及びその制御方法 | |
| JPH07281753A (ja) | 移動ロボット | |
| US20210323163A1 (en) | Mobile Construction Robot | |
| JP2018185767A (ja) | 環境整備ロボットおよびその制御プログラム | |
| US9964956B2 (en) | Operating environment information generating device for mobile robot | |
| KR100904769B1 (ko) | 진로 방해물 감지 장치 및 방법 | |
| TWM477598U (zh) | 具有路線校正功能之移動裝置 | |
| JP4476468B2 (ja) | 脚式移動ロボット | |
| KR20170027767A (ko) | 수평 평면을 이용해 장애물을 검출하는 장치 및 이러한 장치 구현 검출 방법 | |
| JP2009050936A (ja) | 干渉判定装置および脚車輪型ロボット | |
| JP2007190654A (ja) | 脚車輪型ロボット | |
| TWI711913B (zh) | 資訊處理裝置以及移動機器人 | |
| KR101291105B1 (ko) | 선체 도장장치 및 그 제어방법 | |
| KR20080041890A (ko) | 로봇청소기의 외력감지방법, 이를 기록한 기록매체 및 이를이용한 로봇 청소기 | |
| JP5326385B2 (ja) | 走行境界検出装置及び走行境界検出方法 | |
| CN114370881A (zh) | 侦测阻碍物的方法、系统以及其传感器子系统 | |
| JP4377346B2 (ja) | 移動ロボット | |
| JP2018185768A (ja) | 自律移動ロボット | |
| CN215457649U (zh) | 一种扫地机 | |
| JP2016218504A (ja) | 移動装置及び移動システム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A201 | Request for examination | ||
| A302 | Request for accelerated examination | ||
| E902 | Notification of reason for refusal | ||
| E701 | Decision to grant or registration of patent right | ||
| GRNT | Written decision to grant | ||
| FPAY | Annual fee payment |
Payment date: 20130619 Year of fee payment: 5 |
|
| FPAY | Annual fee payment |
Payment date: 20140618 Year of fee payment: 6 |
|
| FPAY | Annual fee payment |
Payment date: 20150618 Year of fee payment: 7 |
|
| FPAY | Annual fee payment |
Payment date: 20160614 Year of fee payment: 8 |
|
| FPAY | Annual fee payment |
Payment date: 20170612 Year of fee payment: 9 |
|
| FPAY | Annual fee payment |
Payment date: 20180611 Year of fee payment: 10 |
|
| FPAY | Annual fee payment |
Payment date: 20190610 Year of fee payment: 11 |