CN107891416A - 一种电磁驱动式球形机器人及其控制方法 - Google Patents
一种电磁驱动式球形机器人及其控制方法 Download PDFInfo
- Publication number
- CN107891416A CN107891416A CN201711079875.5A CN201711079875A CN107891416A CN 107891416 A CN107891416 A CN 107891416A CN 201711079875 A CN201711079875 A CN 201711079875A CN 107891416 A CN107891416 A CN 107891416A
- Authority
- CN
- China
- Prior art keywords
- master controller
- ball shape
- hollow
- electromagnet
- battery
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 239000011324 bead Substances 0.000 claims abstract description 16
- 208000002925 Dental Caries Diseases 0.000 claims abstract description 4
- 238000005096 rolling process Methods 0.000 claims description 32
- 229910001416 lithium ion Inorganic materials 0.000 claims description 12
- 230000005540 biological transmission Effects 0.000 claims description 6
- 230000000007 visual effect Effects 0.000 claims description 5
- 230000015572 biosynthetic process Effects 0.000 claims description 3
- 238000005755 formation reaction Methods 0.000 claims description 3
- 210000000352 storage cell Anatomy 0.000 claims description 3
- WHXSMMKQMYFTQS-UHFFFAOYSA-N lithium Chemical compound data:image/svg+xml;base64,PD94bWwgdmVyc2lvbj0nMS4wJyBlbmNvZGluZz0naXNvLTg4NTktMSc/Pgo8c3ZnIHZlcnNpb249JzEuMScgYmFzZVByb2ZpbGU9J2Z1bGwnCiAgICAgICAgICAgICAgeG1sbnM9J2h0dHA6Ly93d3cudzMub3JnLzIwMDAvc3ZnJwogICAgICAgICAgICAgICAgICAgICAgeG1sbnM6cmRraXQ9J2h0dHA6Ly93d3cucmRraXQub3JnL3htbCcKICAgICAgICAgICAgICAgICAgICAgIHhtbG5zOnhsaW5rPSdodHRwOi8vd3d3LnczLm9yZy8xOTk5L3hsaW5rJwogICAgICAgICAgICAgICAgICB4bWw6c3BhY2U9J3ByZXNlcnZlJwp3aWR0aD0nMzAwcHgnIGhlaWdodD0nMzAwcHgnIHZpZXdCb3g9JzAgMCAzMDAgMzAwJz4KPCEtLSBFTkQgT0YgSEVBREVSIC0tPgo8cmVjdCBzdHlsZT0nb3BhY2l0eToxLjA7ZmlsbDojRkZGRkZGO3N0cm9rZTpub25lJyB3aWR0aD0nMzAwLjAnIGhlaWdodD0nMzAwLjAnIHg9JzAuMCcgeT0nMC4wJz4gPC9yZWN0Pgo8dGV4dCB4PScxMzguMCcgeT0nMTcwLjAnIGNsYXNzPSdhdG9tLTAnIHN0eWxlPSdmb250LXNpemU6NDBweDtmb250LXN0eWxlOm5vcm1hbDtmb250LXdlaWdodDpub3JtYWw7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOm5vbmU7Zm9udC1mYW1pbHk6c2Fucy1zZXJpZjt0ZXh0LWFuY2hvcjpzdGFydDtmaWxsOiMzQjQxNDMnID5MPC90ZXh0Pgo8dGV4dCB4PScxNjUuNicgeT0nMTcwLjAnIGNsYXNzPSdhdG9tLTAnIHN0eWxlPSdmb250LXNpemU6NDBweDtmb250LXN0eWxlOm5vcm1hbDtmb250LXdlaWdodDpub3JtYWw7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOm5vbmU7Zm9udC1mYW1pbHk6c2Fucy1zZXJpZjt0ZXh0LWFuY2hvcjpzdGFydDtmaWxsOiMzQjQxNDMnID5pPC90ZXh0Pgo8cGF0aCBkPSdNIDE4MC4zLDE1MC4wIEwgMTgwLjMsMTQ5LjggTCAxODAuMywxNDkuNyBMIDE4MC4zLDE0OS41IEwgMTgwLjIsMTQ5LjMgTCAxODAuMiwxNDkuMiBMIDE4MC4xLDE0OS4wIEwgMTgwLjAsMTQ4LjkgTCAxNzkuOSwxNDguNyBMIDE3OS44LDE0OC42IEwgMTc5LjcsMTQ4LjUgTCAxNzkuNSwxNDguNCBMIDE3OS40LDE0OC4zIEwgMTc5LjIsMTQ4LjIgTCAxNzkuMSwxNDguMSBMIDE3OC45LDE0OC4xIEwgMTc4LjcsMTQ4LjAgTCAxNzguNiwxNDguMCBMIDE3OC40LDE0OC4wIEwgMTc4LjIsMTQ4LjAgTCAxNzguMCwxNDguMCBMIDE3Ny45LDE0OC4xIEwgMTc3LjcsMTQ4LjEgTCAxNzcuNiwxNDguMiBMIDE3Ny40LDE0OC4yIEwgMTc3LjMsMTQ4LjMgTCAxNzcuMSwxNDguNCBMIDE3Ny4wLDE0OC41IEwgMTc2LjksMTQ4LjcgTCAxNzYuOCwxNDguOCBMIDE3Ni43LDE0OC45IEwgMTc2LjYsMTQ5LjEgTCAxNzYuNSwxNDkuMiBMIDE3Ni40LDE0OS40IEwgMTc2LjQsMTQ5LjYgTCAxNzYuNCwxNDkuNyBMIDE3Ni4zLDE0OS45IEwgMTc2LjMsMTUwLjEgTCAxNzYuNCwxNTAuMyBMIDE3Ni40LDE1MC40IEwgMTc2LjQsMTUwLjYgTCAxNzYuNSwxNTAuOCBMIDE3Ni42LDE1MC45IEwgMTc2LjcsMTUxLjEgTCAxNzYuOCwxNTEuMiBMIDE3Ni45LDE1MS4zIEwgMTc3LjAsMTUxLjUgTCAxNzcuMSwxNTEuNiBMIDE3Ny4zLDE1MS43IEwgMTc3LjQsMTUxLjggTCAxNzcuNiwxNTEuOCBMIDE3Ny43LDE1MS45IEwgMTc3LjksMTUxLjkgTCAxNzguMCwxNTIuMCBMIDE3OC4yLDE1Mi4wIEwgMTc4LjQsMTUyLjAgTCAxNzguNiwxNTIuMCBMIDE3OC43LDE1Mi4wIEwgMTc4LjksMTUxLjkgTCAxNzkuMSwxNTEuOSBMIDE3OS4yLDE1MS44IEwgMTc5LjQsMTUxLjcgTCAxNzkuNSwxNTEuNiBMIDE3OS43LDE1MS41IEwgMTc5LjgsMTUxLjQgTCAxNzkuOSwxNTEuMyBMIDE4MC4wLDE1MS4xIEwgMTgwLjEsMTUxLjAgTCAxODAuMiwxNTAuOCBMIDE4MC4yLDE1MC43IEwgMTgwLjMsMTUwLjUgTCAxODAuMywxNTAuMyBMIDE4MC4zLDE1MC4yIEwgMTgwLjMsMTUwLjAgTCAxNzguMywxNTAuMCBaJyBzdHlsZT0nZmlsbDojMDAwMDAwO2ZpbGwtcnVsZTpldmVub2RkO2ZpbGwtb3BhY2l0eToxO3N0cm9rZTojMDAwMDAwO3N0cm9rZS13aWR0aDowLjBweDtzdHJva2UtbGluZWNhcDpidXR0O3N0cm9rZS1saW5lam9pbjptaXRlcjtzdHJva2Utb3BhY2l0eToxOycgLz4KPC9zdmc+Cg== data:image/svg+xml;base64,PD94bWwgdmVyc2lvbj0nMS4wJyBlbmNvZGluZz0naXNvLTg4NTktMSc/Pgo8c3ZnIHZlcnNpb249JzEuMScgYmFzZVByb2ZpbGU9J2Z1bGwnCiAgICAgICAgICAgICAgeG1sbnM9J2h0dHA6Ly93d3cudzMub3JnLzIwMDAvc3ZnJwogICAgICAgICAgICAgICAgICAgICAgeG1sbnM6cmRraXQ9J2h0dHA6Ly93d3cucmRraXQub3JnL3htbCcKICAgICAgICAgICAgICAgICAgICAgIHhtbG5zOnhsaW5rPSdodHRwOi8vd3d3LnczLm9yZy8xOTk5L3hsaW5rJwogICAgICAgICAgICAgICAgICB4bWw6c3BhY2U9J3ByZXNlcnZlJwp3aWR0aD0nODVweCcgaGVpZ2h0PSc4NXB4JyB2aWV3Qm94PScwIDAgODUgODUnPgo8IS0tIEVORCBPRiBIRUFERVIgLS0+CjxyZWN0IHN0eWxlPSdvcGFjaXR5OjEuMDtmaWxsOiNGRkZGRkY7c3Ryb2tlOm5vbmUnIHdpZHRoPSc4NS4wJyBoZWlnaHQ9Jzg1LjAnIHg9JzAuMCcgeT0nMC4wJz4gPC9yZWN0Pgo8dGV4dCB4PSczNS4wJyB5PSc1My42JyBjbGFzcz0nYXRvbS0wJyBzdHlsZT0nZm9udC1zaXplOjIzcHg7Zm9udC1zdHlsZTpub3JtYWw7Zm9udC13ZWlnaHQ6bm9ybWFsO2ZpbGwtb3BhY2l0eToxO3N0cm9rZTpub25lO2ZvbnQtZmFtaWx5OnNhbnMtc2VyaWY7dGV4dC1hbmNob3I6c3RhcnQ7ZmlsbDojM0I0MTQzJyA+TDwvdGV4dD4KPHRleHQgeD0nNTEuMCcgeT0nNTMuNicgY2xhc3M9J2F0b20tMCcgc3R5bGU9J2ZvbnQtc2l6ZToyM3B4O2ZvbnQtc3R5bGU6bm9ybWFsO2ZvbnQtd2VpZ2h0Om5vcm1hbDtmaWxsLW9wYWNpdHk6MTtzdHJva2U6bm9uZTtmb250LWZhbWlseTpzYW5zLXNlcmlmO3RleHQtYW5jaG9yOnN0YXJ0O2ZpbGw6IzNCNDE0MycgPmk8L3RleHQ+CjxwYXRoIGQ9J00gNjEuMiw0Mi4wIEwgNjEuMiw0MS45IEwgNjEuMiw0MS44IEwgNjEuMiw0MS43IEwgNjEuMiw0MS42IEwgNjEuMSw0MS41IEwgNjEuMSw0MS40IEwgNjEuMCw0MS4zIEwgNjEuMCw0MS4zIEwgNjAuOSw0MS4yIEwgNjAuOCw0MS4xIEwgNjAuNyw0MS4xIEwgNjAuNyw0MS4wIEwgNjAuNiw0MS4wIEwgNjAuNSw0MC45IEwgNjAuNCw0MC45IEwgNjAuMyw0MC45IEwgNjAuMiw0MC44IEwgNjAuMSw0MC44IEwgNjAuMCw0MC44IEwgNTkuOSw0MC45IEwgNTkuOCw0MC45IEwgNTkuNyw0MC45IEwgNTkuNiw0MC45IEwgNTkuNSw0MS4wIEwgNTkuNCw0MS4wIEwgNTkuNCw0MS4xIEwgNTkuMyw0MS4yIEwgNTkuMiw0MS4yIEwgNTkuMSw0MS4zIEwgNTkuMSw0MS40IEwgNTkuMCw0MS41IEwgNTkuMCw0MS42IEwgNTkuMCw0MS43IEwgNTguOSw0MS44IEwgNTguOSw0MS45IEwgNTguOSw0Mi4wIEwgNTguOSw0Mi4wIEwgNTguOSw0Mi4xIEwgNTguOSw0Mi4yIEwgNTkuMCw0Mi4zIEwgNTkuMCw0Mi40IEwgNTkuMCw0Mi41IEwgNTkuMSw0Mi42IEwgNTkuMSw0Mi43IEwgNTkuMiw0Mi44IEwgNTkuMyw0Mi44IEwgNTkuNCw0Mi45IEwgNTkuNCw0My4wIEwgNTkuNSw0My4wIEwgNTkuNiw0My4xIEwgNTkuNyw0My4xIEwgNTkuOCw0My4xIEwgNTkuOSw0My4xIEwgNjAuMCw0My4yIEwgNjAuMSw0My4yIEwgNjAuMiw0My4yIEwgNjAuMyw0My4xIEwgNjAuNCw0My4xIEwgNjAuNSw0My4xIEwgNjAuNiw0My4wIEwgNjAuNyw0My4wIEwgNjAuNyw0Mi45IEwgNjAuOCw0Mi45IEwgNjAuOSw0Mi44IEwgNjEuMCw0Mi43IEwgNjEuMCw0Mi43IEwgNjEuMSw0Mi42IEwgNjEuMSw0Mi41IEwgNjEuMiw0Mi40IEwgNjEuMiw0Mi4zIEwgNjEuMiw0Mi4yIEwgNjEuMiw0Mi4xIEwgNjEuMiw0Mi4wIEwgNjAuMSw0Mi4wIFonIHN0eWxlPSdmaWxsOiMwMDAwMDA7ZmlsbC1ydWxlOmV2ZW5vZGQ7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOiMwMDAwMDA7c3Ryb2tlLXdpZHRoOjAuMHB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjE7JyAvPgo8L3N2Zz4K [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 claims 1
- 229910052744 lithium Inorganic materials 0.000 claims 1
- 210000003128 Head Anatomy 0.000 description 23
- XEEYBQQBJWHFJM-UHFFFAOYSA-N iron Chemical compound data:image/svg+xml;base64,PD94bWwgdmVyc2lvbj0nMS4wJyBlbmNvZGluZz0naXNvLTg4NTktMSc/Pgo8c3ZnIHZlcnNpb249JzEuMScgYmFzZVByb2ZpbGU9J2Z1bGwnCiAgICAgICAgICAgICAgeG1sbnM9J2h0dHA6Ly93d3cudzMub3JnLzIwMDAvc3ZnJwogICAgICAgICAgICAgICAgICAgICAgeG1sbnM6cmRraXQ9J2h0dHA6Ly93d3cucmRraXQub3JnL3htbCcKICAgICAgICAgICAgICAgICAgICAgIHhtbG5zOnhsaW5rPSdodHRwOi8vd3d3LnczLm9yZy8xOTk5L3hsaW5rJwogICAgICAgICAgICAgICAgICB4bWw6c3BhY2U9J3ByZXNlcnZlJwp3aWR0aD0nMzAwcHgnIGhlaWdodD0nMzAwcHgnIHZpZXdCb3g9JzAgMCAzMDAgMzAwJz4KPCEtLSBFTkQgT0YgSEVBREVSIC0tPgo8cmVjdCBzdHlsZT0nb3BhY2l0eToxLjA7ZmlsbDojRkZGRkZGO3N0cm9rZTpub25lJyB3aWR0aD0nMzAwLjAnIGhlaWdodD0nMzAwLjAnIHg9JzAuMCcgeT0nMC4wJz4gPC9yZWN0Pgo8dGV4dCB4PScxMzguMCcgeT0nMTcwLjAnIGNsYXNzPSdhdG9tLTAnIHN0eWxlPSdmb250LXNpemU6NDBweDtmb250LXN0eWxlOm5vcm1hbDtmb250LXdlaWdodDpub3JtYWw7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOm5vbmU7Zm9udC1mYW1pbHk6c2Fucy1zZXJpZjt0ZXh0LWFuY2hvcjpzdGFydDtmaWxsOiMzQjQxNDMnID5GPC90ZXh0Pgo8dGV4dCB4PScxNjUuNicgeT0nMTcwLjAnIGNsYXNzPSdhdG9tLTAnIHN0eWxlPSdmb250LXNpemU6NDBweDtmb250LXN0eWxlOm5vcm1hbDtmb250LXdlaWdodDpub3JtYWw7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOm5vbmU7Zm9udC1mYW1pbHk6c2Fucy1zZXJpZjt0ZXh0LWFuY2hvcjpzdGFydDtmaWxsOiMzQjQxNDMnID5lPC90ZXh0Pgo8L3N2Zz4K data:image/svg+xml;base64,PD94bWwgdmVyc2lvbj0nMS4wJyBlbmNvZGluZz0naXNvLTg4NTktMSc/Pgo8c3ZnIHZlcnNpb249JzEuMScgYmFzZVByb2ZpbGU9J2Z1bGwnCiAgICAgICAgICAgICAgeG1sbnM9J2h0dHA6Ly93d3cudzMub3JnLzIwMDAvc3ZnJwogICAgICAgICAgICAgICAgICAgICAgeG1sbnM6cmRraXQ9J2h0dHA6Ly93d3cucmRraXQub3JnL3htbCcKICAgICAgICAgICAgICAgICAgICAgIHhtbG5zOnhsaW5rPSdodHRwOi8vd3d3LnczLm9yZy8xOTk5L3hsaW5rJwogICAgICAgICAgICAgICAgICB4bWw6c3BhY2U9J3ByZXNlcnZlJwp3aWR0aD0nODVweCcgaGVpZ2h0PSc4NXB4JyB2aWV3Qm94PScwIDAgODUgODUnPgo8IS0tIEVORCBPRiBIRUFERVIgLS0+CjxyZWN0IHN0eWxlPSdvcGFjaXR5OjEuMDtmaWxsOiNGRkZGRkY7c3Ryb2tlOm5vbmUnIHdpZHRoPSc4NS4wJyBoZWlnaHQ9Jzg1LjAnIHg9JzAuMCcgeT0nMC4wJz4gPC9yZWN0Pgo8dGV4dCB4PSczNS4wJyB5PSc1My42JyBjbGFzcz0nYXRvbS0wJyBzdHlsZT0nZm9udC1zaXplOjIzcHg7Zm9udC1zdHlsZTpub3JtYWw7Zm9udC13ZWlnaHQ6bm9ybWFsO2ZpbGwtb3BhY2l0eToxO3N0cm9rZTpub25lO2ZvbnQtZmFtaWx5OnNhbnMtc2VyaWY7dGV4dC1hbmNob3I6c3RhcnQ7ZmlsbDojM0I0MTQzJyA+RjwvdGV4dD4KPHRleHQgeD0nNTEuMCcgeT0nNTMuNicgY2xhc3M9J2F0b20tMCcgc3R5bGU9J2ZvbnQtc2l6ZToyM3B4O2ZvbnQtc3R5bGU6bm9ybWFsO2ZvbnQtd2VpZ2h0Om5vcm1hbDtmaWxsLW9wYWNpdHk6MTtzdHJva2U6bm9uZTtmb250LWZhbWlseTpzYW5zLXNlcmlmO3RleHQtYW5jaG9yOnN0YXJ0O2ZpbGw6IzNCNDE0MycgPmU8L3RleHQ+Cjwvc3ZnPgo= [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 22
- 229910052742 iron Inorganic materials 0.000 description 11
- 230000001276 controlling effect Effects 0.000 description 7
- 230000005484 gravity Effects 0.000 description 6
- 238000001514 detection method Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000005611 electricity Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000000875 corresponding Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- PXHVJJICTQNCMI-UHFFFAOYSA-N nickel Chemical compound data:image/svg+xml;base64,PD94bWwgdmVyc2lvbj0nMS4wJyBlbmNvZGluZz0naXNvLTg4NTktMSc/Pgo8c3ZnIHZlcnNpb249JzEuMScgYmFzZVByb2ZpbGU9J2Z1bGwnCiAgICAgICAgICAgICAgeG1sbnM9J2h0dHA6Ly93d3cudzMub3JnLzIwMDAvc3ZnJwogICAgICAgICAgICAgICAgICAgICAgeG1sbnM6cmRraXQ9J2h0dHA6Ly93d3cucmRraXQub3JnL3htbCcKICAgICAgICAgICAgICAgICAgICAgIHhtbG5zOnhsaW5rPSdodHRwOi8vd3d3LnczLm9yZy8xOTk5L3hsaW5rJwogICAgICAgICAgICAgICAgICB4bWw6c3BhY2U9J3ByZXNlcnZlJwp3aWR0aD0nMzAwcHgnIGhlaWdodD0nMzAwcHgnIHZpZXdCb3g9JzAgMCAzMDAgMzAwJz4KPCEtLSBFTkQgT0YgSEVBREVSIC0tPgo8cmVjdCBzdHlsZT0nb3BhY2l0eToxLjA7ZmlsbDojRkZGRkZGO3N0cm9rZTpub25lJyB3aWR0aD0nMzAwLjAnIGhlaWdodD0nMzAwLjAnIHg9JzAuMCcgeT0nMC4wJz4gPC9yZWN0Pgo8dGV4dCB4PScxMzguMCcgeT0nMTcwLjAnIGNsYXNzPSdhdG9tLTAnIHN0eWxlPSdmb250LXNpemU6NDBweDtmb250LXN0eWxlOm5vcm1hbDtmb250LXdlaWdodDpub3JtYWw7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOm5vbmU7Zm9udC1mYW1pbHk6c2Fucy1zZXJpZjt0ZXh0LWFuY2hvcjpzdGFydDtmaWxsOiMzQjQxNDMnID5OPC90ZXh0Pgo8dGV4dCB4PScxNjUuNicgeT0nMTcwLjAnIGNsYXNzPSdhdG9tLTAnIHN0eWxlPSdmb250LXNpemU6NDBweDtmb250LXN0eWxlOm5vcm1hbDtmb250LXdlaWdodDpub3JtYWw7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOm5vbmU7Zm9udC1mYW1pbHk6c2Fucy1zZXJpZjt0ZXh0LWFuY2hvcjpzdGFydDtmaWxsOiMzQjQxNDMnID5pPC90ZXh0Pgo8L3N2Zz4K data:image/svg+xml;base64,PD94bWwgdmVyc2lvbj0nMS4wJyBlbmNvZGluZz0naXNvLTg4NTktMSc/Pgo8c3ZnIHZlcnNpb249JzEuMScgYmFzZVByb2ZpbGU9J2Z1bGwnCiAgICAgICAgICAgICAgeG1sbnM9J2h0dHA6Ly93d3cudzMub3JnLzIwMDAvc3ZnJwogICAgICAgICAgICAgICAgICAgICAgeG1sbnM6cmRraXQ9J2h0dHA6Ly93d3cucmRraXQub3JnL3htbCcKICAgICAgICAgICAgICAgICAgICAgIHhtbG5zOnhsaW5rPSdodHRwOi8vd3d3LnczLm9yZy8xOTk5L3hsaW5rJwogICAgICAgICAgICAgICAgICB4bWw6c3BhY2U9J3ByZXNlcnZlJwp3aWR0aD0nODVweCcgaGVpZ2h0PSc4NXB4JyB2aWV3Qm94PScwIDAgODUgODUnPgo8IS0tIEVORCBPRiBIRUFERVIgLS0+CjxyZWN0IHN0eWxlPSdvcGFjaXR5OjEuMDtmaWxsOiNGRkZGRkY7c3Ryb2tlOm5vbmUnIHdpZHRoPSc4NS4wJyBoZWlnaHQ9Jzg1LjAnIHg9JzAuMCcgeT0nMC4wJz4gPC9yZWN0Pgo8dGV4dCB4PSczNS4wJyB5PSc1My42JyBjbGFzcz0nYXRvbS0wJyBzdHlsZT0nZm9udC1zaXplOjIzcHg7Zm9udC1zdHlsZTpub3JtYWw7Zm9udC13ZWlnaHQ6bm9ybWFsO2ZpbGwtb3BhY2l0eToxO3N0cm9rZTpub25lO2ZvbnQtZmFtaWx5OnNhbnMtc2VyaWY7dGV4dC1hbmNob3I6c3RhcnQ7ZmlsbDojM0I0MTQzJyA+TjwvdGV4dD4KPHRleHQgeD0nNTEuMCcgeT0nNTMuNicgY2xhc3M9J2F0b20tMCcgc3R5bGU9J2ZvbnQtc2l6ZToyM3B4O2ZvbnQtc3R5bGU6bm9ybWFsO2ZvbnQtd2VpZ2h0Om5vcm1hbDtmaWxsLW9wYWNpdHk6MTtzdHJva2U6bm9uZTtmb250LWZhbWlseTpzYW5zLXNlcmlmO3RleHQtYW5jaG9yOnN0YXJ0O2ZpbGw6IzNCNDE0MycgPmk8L3RleHQ+Cjwvc3ZnPgo= [Ni] PXHVJJICTQNCMI-UHFFFAOYSA-N 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 230000002459 sustained Effects 0.000 description 2
- 241001247986 Calotropis procera Species 0.000 description 1
- 210000000887 Face Anatomy 0.000 description 1
- 210000001503 Joints Anatomy 0.000 description 1
- 238000010521 absorption reaction Methods 0.000 description 1
- 230000002493 climbing Effects 0.000 description 1
- GUTLYIVDDKVIGB-UHFFFAOYSA-N cobalt Chemical compound data:image/svg+xml;base64,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 data:image/svg+xml;base64,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 [Co] GUTLYIVDDKVIGB-UHFFFAOYSA-N 0.000 description 1
- 229910052803 cobalt Inorganic materials 0.000 description 1
- 239000010941 cobalt Substances 0.000 description 1
- 238000007405 data analysis Methods 0.000 description 1
- 230000002349 favourable Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000003973 irrigation Methods 0.000 description 1
- 230000002262 irrigation Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 229910052751 metal Inorganic materials 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000000051 modifying Effects 0.000 description 1
- 238000000465 moulding Methods 0.000 description 1
- 229910052759 nickel Inorganic materials 0.000 description 1
- 238000004805 robotic Methods 0.000 description 1
- 230000001568 sexual Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Classifications
-
- 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/0009—Constructional details, e.g. manipulator supports, bases
-
- 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
-
- 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
Abstract
本发明公开了一种电磁驱动式球形机器人及其控制方法,球体支架、主控制器和电源,球体支架包括若干空心容腔以及用于将空心容腔连接成球体支架的空心管道,空心管道内部均放置有若干可滚动的小球空心容腔包括上下两个腔体,上腔体中设置有电磁铁,下腔体用于容纳小球,下腔体与空心管道形成相通的空腔作为小球的运动通道,主控制器用于控制电源给电磁铁的通、断电时机,采用磁铁驱动,驱动方向可以随意控制,可以向任何方向转动。
Description
_种电磁驱动式球形机器人及其控制方法
技术领域
[0001] 本发明属于机器人技术领域,具体涉及一种电磁驱动式球形机器人及其控制方 法。
背景技术
[0002] 机器人在现代生活中正逐渐替代人类发挥着日益重要的作用。近年来,随着机器 人技术的迅速发展、应用范围的扩大和自动化程度的进一步提高,人们对机器人的功能提 出了更高的要求,特别是需要各种具有较合理的机器人优化结构和不同程度智能的机器人 装置。与此同时,机器人面临的工作环境也越来越恶劣,如星际探索、极地勘测、军事侦察以 及反恐活动等。在这些应用领域中地形环境往往很复杂,存在各式各样的障碍物或沟渠,有 时还存在危险性,这就要求机器人具有很强的机动性和灵活性。传统的安防依靠人力,开销 大,且存在一定的疏漏。很多企业和家庭的安防仍停留在红外监控和视频监控阶段,而且存 在停电状态,所以传统安防会受到诸多限制。而现有的球形结构机器人驱动方式比较单一, 主要靠重力产生偏心距来提供动力,这种结构缺点是不能任意调整机器人前进的角度,且 结构笨重。
发明内容
[0003] 为了解决上述问题,本发明提供了一种电磁驱动式球形机器人及其控制方法,本 发明设计合理,通过设置电磁铁及为电磁铁和小铁球,以及为小铁球的滚动提供路径的空 心管道,使小铁球可以顺着管道移动,流向空心容腔内,使球体中心偏移,由于重力产生动 力带动球体转动,球形转弯半径很小,可以轻易的实现转弯半径接近零的原地自旋转弯。
[0004] 为达到上述目的,本发明所述一种电磁驱动式球形机器人包括球体支架、主控制 器和蓄电池,球体支架包括若千空心容腔以及用于将空心容腔连接成球体支架的空心管 道,空心管道内部均放置有若干可滚动的小球,小球能够被电磁铁吸引,空心容腔包括上下 两个腔体,上腔体中设置有电磁铁,下腔体用于容纳小球,下腔体与空心管道形成相通的空 腔作为小球的运动通道,每个空心容腔中均设置有磁力传感器,球体支架内部固定设置有 位置传感器、速度传感器、主控制器和蓄电池,磁力传感器、位置传感器、速度传感器、主控 制器和蓄电池均与主控制器通信连接。
[0005]进一步的,还包括设置在球体支架中的三自由度云台,三自由度云台包括俯仰轴、 方位轴和滚转轴,俯仰轴包括空腔,和穿过空腔的转动轴,转动轴一端与电机的输出轴连 接,另一端通过俯仰轴座与空心容腔连接,空腔通过方位轴与半球体支架联通,半球体支架 中设置有滚动轴,滚动轴一端伸出半球体支架,且伸出半球体支架的一端与相机架固定连 接,空腔中设置有方位电机,方位电机的输出轴与转动轴垂直,方位电机用于驱动半球体支 架进行圆周运动,半球体支架中设置有同时垂直于俯仰轴和方位轴的滚转电机。
[0006]进一步的,方位电机与方位控制驱动模块连接,电机与俯仰驱动控制模块连接、滚 转电机与滚转驱动控制模块连接,方位控制驱动模块、俯仰驱动控制模块和滚转驱动控制 模块均与主控器连接。
[0007] 进一步的,磁力传感器用于确定电磁铁是否工作以及当前磁铁的磁力大小并将测 量到的磁力信息反馈给主控制器;位置传感器用于确定当前球形机器人以及三自由度云台 的位置并将位置信息反馈给主控制器;速度传感器用于测量球形机器人的运动速度并将速 度信息反馈给主控制器;主控制器用于接收磁力传感器、位置传感器以及速度传感器传递 的信息,并根据接收到的信息判断机器人运动轨迹是否为设定的轨迹,然后根据判断结果 向蓄电池、方位控制驱动模块、俯仰驱动控制模块和滚转驱动控制模块发出控制信号、以控 制源给电磁铁的通、断电蓄电池的时机,以及三自由度云台中各个电机的工作状态,使机器 人的运动轨迹保持不变且三自由度云台始终保持给定的初始姿态。
[0008] 进一步的,球体支架包括26个空心容腔,26个空心容腔中有8个含有3个空心管道 连接口,18个含有4个空心管道连接口,含有3个空心管道连接口设置在是斜向45度方向,9 个含有4个空心管道连接口均匀设置在球体支架的最大圆环上,另外9个含有4个空心管道 连接口形成的均匀设置在球体支架的另一个半径最大的圆环上,上述两个圆环相互垂直。 [0009] 进一步的,蓄电池为锂离子蓄电池。
[0010]进一步的,每个空心容腔中均设置有锂离子蓄电池,每块锂离子蓄电池与和与其 位于同一空心容腔的电磁铁连接,所有的锂离子蓄电池通过导线与主控制器连接。
[0011]进一步的,锂离子蓄电池设置在俯仰轴的空腔中,锂离子蓄电池的输入端与主控 制器连接,设置与电磁铁数量相同数量的输出端分别连接至不同的电磁铁。
[0012] —种电磁驱动式球形机器人的控制方法,包括以下步骤:
[0013]步骤1,设定机器人的运动轨迹和运动速度,以及机器人上摄像装置的初始位置; [0014]步骤2,机器人上设置的传感器测量机器人和摄像装置的位置信息、速度信息,并 将测量到的信息传递给主控制器,主控制器根据接收到的信息,计算机器人转过的角度,并 根据计算结果对摄像装置的位置进行校正,使摄像装置保持初始视角,同时判断机器人的 是否在设定的轨迹上运动,若在设定的轨迹上则不动作,若不在设定的轨迹上,发送控制信 号至蓄电池,通过蓄电池给予电磁铁电流的大小控制机器人的运动轨迹;摄像装置设置在 具有三个自由度的装置上,主控制器通过控制设置在具有三个自由度的装置上的驱动控制 模块和电机实现对摄像装置位置的控制。
[0015]与现有技术相比,本发明至少具有以下有益的技术效果,本发明采用磁铁驱动,行 动灵活,几乎没有死角,转弯半径很小,可以轻易的实现转弯半径接近零的原地自旋转弯; 其球形结构可以自由地向任何方向旋转实现全方位滚动行走,所以对球形机器人来说所有 的位置都是稳定的,采用自动控制,通过设置在机器人上的传感器实时向主控制器发送信 息,主控制器进行计算并向驱动控制模块发出控制命令,使摄像装置始终保持在同一视角, 拍摄的画面清晰、连续,为使用者提供了方便。
[0016]进一步的,还包括设置在球体支架中的三自由度云台,三自由度云台包括俯仰轴、 方位轴和滚转轴,俯仰轴包括空腔,和穿过空腔的转动轴,转动轴一端与电机的输出轴连 接,另一端通过俯仰轴座与空心容腔连接,空腔通过方位轴与半球体支架联通,半球体支架 中设置有滚动轴,滚动轴一端伸出半球体支架,且伸出半球体支架的一端与相机架固定连 接,空腔中设置有方位电机,方位电机的输出轴与转动轴垂直,方位电机用于驱动半球体支 架进行圆周运动,半球体支架中设置有同时垂直于俯仰轴和方位轴的滚转电机,该结构充 分利用内部空间,在内部安装三自由度云台,云台内部和外部可以安装各种检测传感器或 者摄像头,并且该三自由度云台可以保证传感器的位置始终为设定的方向,这样可以抵消 其他千扰对传感器的影响。
[0017] 进一步的,方位电机与方位控制驱动模块连接,电机与俯仰驱动控制模块连接、滚 转电机与滚转驱动控制模块连接,方位控制驱动模块、俯仰驱动控制模块和滚转驱动控制 模块均与主控器连接,通过控制器对三自由云台三个自由度进行自动控制,操作方便。
[0018]进一步的,磁力传感器用于确定电磁铁是否工作以及当前磁铁的磁力大小并将测 量到的磁力信息反馈给主控制器;位置传感器用于确定当前球形机器人以及三自由度云台 的位置并将位置信息反馈给主控制器;速度传感器用于测量球形机器人的运动速度并将速 度信息反馈给主控制器;主控制器用于接收磁力传感器、位置传感器以及速度传感器传递 的信息,并根据接收到的信息判断机器人运动轨迹是否为设定的轨迹,然后根据判断结果 向蓄电池、方位控制驱动模块、俯仰驱动控制模块和滚转驱动控制模块发出控制信号、以控 制源给电磁铁的通、断电蓄电池的时机,以及三自由度云台中各个电机的工作状态,使机器 人的运动轨迹保持不变且三自由度云台始终保持给定的初始姿态,通过传感器与控制器间 的配合,可以实现目标检测,目标跟踪和视觉伺服的功能。由于球形机器人所有零部件都封 装在一个球体支架内,因此其内部部件可以得到球壳的可靠保护。
[0019]进一步的,球体支架包括26个空心容腔,26个空心容腔中有8个含有3个空心管道 连接口,1S个含有4个空心管道连接口,含有3个空心管道连接口设置在是斜向45度方向,9 个含有4个空心管道连接口均匀设置在球体支架的最大圆环上,另外9个含有4个空心管道 连接口形成的均匀设置在球体支架的另一个半径最大的圆环上,上述两个圆环相互垂直。 可以覆盖360度方向。
[0020]进一步的,蓄电池为锂离子蓄电池,性价比高,适应环境广泛。
附图说明
[0021] 图1为球形安防机器人的外形结构示意图;
[0022] 图2为含有4个空心管道连接口结构示意图;
[0023]图3为含有3个空心管道连接口构示意图;’
[0024]图4为球形安防机器人的云台结构示意图;
[0025]附图中:1一空心容腔,2—方位轴,3一电机,4一橡胶套筒,5—空心管道,6一俯仰 轴座,7—俯仰轴,71—空腔、8—滚转轴,9—相机架,1〇 一半球体支架。
具体实施方式
[0026]下面结合附图和具体实施方式对本发明进行详细说明。
[0027]参照图1至图4,本发明包括管型支架组成的球体支架和三自由度云台,球体支架 包括若干节点以及连接节点的管道,其结构是以空心容腔丨为节点将空心管道5连接成球体 支架,空心容腔1设置在球体支架表面,空心管道5之间通过橡胶套筒4连接,空心容腔1为圆 柱形,每个空心容腔^1分为上下两个腔体,上腔体用于容置电磁铁,下腔体用于容纳小小铁 球,中间不相通,下腔体与空心管道5形成相通的空腔作为小球的运动通道,空心容腔1及空 心管道5采用非磁性材料,所有的关节通过空心管道5连通,空心管道5内部均放置有若干可 滚动的小球,小球由铁、钴和镍等能被磁铁吸引的金属制成,优选铁材料。
[0028] 参照图2,含有4个空心管道连接口包括1个空心容腔1和4个与空心容腔1联通的空 心管道5,4个空心管道5位于空心容腔1的同一高度位置且均匀分布在空心容腔1的外周。 [0029] 参照图3,含有3个空心管道连接口包括1个空心容腔1和3个与空心容腔1联通的空 心管道5,3个空心管道5位于空心容腔1的同一高度位置且均匀分布在空心容腔1的外周。 [0030] 参照图4,三自由度云台包括俯仰轴7、方位轴2和滚转轴8,俯仰轴7和球体支架的 一条直径相重合,俯仰轴7包括转动轴和一个空腔71,转动轴穿过空腔71,转动轴一端与电 机3的输出轴连接,另一端通过俯仰轴座6与空心容腔连接,空腔71上方设置有方位轴2,方 位轴2为圆筒,方位轴2上连接有半球体支架10,半球体支架10通过方位轴2与空腔联通,半 球体支架10中设置有滚动轴8,滚动轴8—端伸出半球体支架10,且伸出半球体支架10的一 端与相机架9固定连接,相机架9中设置有相机或摄像头,相机或摄像头与主控器连接。电机 3控制俯仰轴7的转动,空腔中还设置有方位电机,方位电机的输出轴与转动轴垂直,方位电 机用于驱动半球体支架10进行圆周运动,半球体支架10的运动轨迹形成的平面与俯仰轴7 平行。半球体支架10中设置有同时垂直于俯仰轴7和方位轴2的滚转电机,用来控制相机架9 的滚转,相机架9的运动轨迹形成的平面与方位轴2和俯仰轴7所构成的平面相平行,电机3、 方位电机和滚转电机均为无刷直流电机,三自由度的驱动点包括无刷直流电机和相应的控 制模块,相应的控制模块分别为位于空腔内的方位驱动控制模块、与空心容腔1相接的电机 座上的俯仰驱动控制模块、在与方位轴2顶端相接的小球壳体内的滚转驱动控制模块。控制 系统包括主控制器和传感器,传感器包括一个位置传感器,一个速度传感器和磁力传感器, 磁力传感器的数量与节点的数量一致,上述所有的传感器、方位控制模块、俯仰控制模块和 滚转控制模块均与主控制器通过导线连接。位置传感器和速度传感器均位于三自由度云台 上,磁力传感器位于空心容腔内,主控制器位于俯仰轴7的腔体内,主控制器采用DSP28335, 主控制器接收到这些传感器的信号,并对信号加以分析来控制电磁铁的通电顺序及断电的 时机,电磁铁由主控制器通过控制蓄电池给、断电,通过传感器与控制器间的配合,可以实 现目标检测,目标跟踪和视觉伺服的功能。具体为:磁力传感器用于确定电磁铁是否工作以 及当前磁铁的磁力大小并将结果反馈给主控制器,主控制器根据反馈的结果来判断当前磁 铁是否接通,并且根据当前情况判断是否加大电流来增大磁力;位置传感器用于确定当前 球形机器人以及三自由度云台的位置;速度传感器用于测量球形机器人的运动速度;主控 制器用于接收磁力传感器、位置传感器以及磁力传感器传递的信号,并据此分析该球形机 器人运动轨迹是否为设定的轨迹并且实时的调节三自由度云台的位置,相机或摄像头的的 拍摄角度保持不变,然后主控制器根据计算的参数控制蓄电池给电磁铁的通、断电时机以 控制本机器人的运动。
[0031] 本发明的工作过程如下:
[0032]当设定好运动轨迹时候,主控制器根据初始位置时电磁铁的编号顺序,计算出最 优的通电次序,这时球形机器人内部管道的小球沿着管道到达空心容腔附近,同时磁力传 感器给主控制器反馈各个电磁铁的工作情况。随后因为小铁球的重力产生的重力矩带动机 器人的运动,并且位于三自由度上的位置传感器和速度传感器测量出当前机器人的运动状 态以及三自由度云台的位置信息,将这些信息反馈给主控制器,主控制将这些数据分析后 向方位驱动控制模块、俯仰驱动控制模块、滚转驱动控制模块以及电磁铁发送控制指令,进 而控制三自由度云台电机和各个电磁铁的工作,使机器人的运动轨迹保持不变且三自由度 云台始终保持给定的初始姿态,方便三自由度云台上的相机或摄像头进行画面捕捉。
[0033]由于球形机器人所有零部件都封装在一个球壳内,因此其内部部件可以得到球壳 的可靠保护。
[0034]蓄电池与主控制器及电磁铁的连接方式为以下方式中的任意一种:
[0035] —种方式是:每个空心容腔1中均设置有蓄电池,即蓄电池的数量与电磁铁的数量 一致,每块蓄电池与和与其位于同一空心容腔1的电磁铁连接,所有的蓄电池通过导线与主 控制器连接。
[0036]另一种方式是:仅有一个蓄电池,该蓄电池设置在俯仰轴7的空腔中,蓄电池的输 入端与主控制器连接,设置与电磁铁数量相同数量的输出端分别连接至不同的电磁铁。 [0037]优选的,球体支架的节点数量为26,球体支架包括若干空心管道5、26个空心容腔 1、26个电磁铁、若干小铁球以及若干套筒。26个空心容腔1中有8个含有3个空心管道连接 口,18个含有4个空心管道连接口,含有3个空心管道连接口设置在是斜向45度方向,9个含 有4个空心管道连接口均匀设置在球体支架的最大圆环上,另外9个含有4个空心管道连接 口均匀设置在球体支架的另一个半径最大的圆环上,以上两个圆环相互垂直,可以覆盖360 度方向。
[0038]球形安防机器人具有一个球形或类球形的外壳,以滚动方式行走,该球体主支架 是由26个节点相连的管状通道组成,这26个节点分别位于壳体的的水平对称平面、竖直对 称平面以及45°方向,位于45°方向的节点与球心之间的连线与水平对称平面的夹角为45°, 使每个节点在转动时候保证有三个节点同时与地面接触,考虑控制和重量的优化性选择26 个节点,每个节点中均设置有一个控制电磁铁,通过控制控制电磁铁的通电顺序,来控制机 器人的运动方向和时机,每一段空心管道5内部均放置有若干可滚动的小球,这些小铁球可 以顺着管道移动,流向空心容腔1内,使球体支架中心偏移,由于重力产生动力带动球体转 动。球形机器人的行走驱动是通过控制磁铁对内部可滚动小铁球的吸附改变自身重心的位 置产生的转矩并结合外界摩擦力产生滚动运动。
[0039]从球形机器人的外形来说,球形结构可以使其内部体积最大化,也可以提供最佳 的力用以抵抗内部过压或压力不足,这种特性对于水下或太空应用也是非常有利的。其最 大的特点是运动方式特殊,球形的外壳将使机器人能在失稳后获得最大的稳定性,与用轮 子滚动行走的轮式机器人相比,不存在“翻倒”的问题,并且能在多个方向上实现滚动;与步 行或爬行机器人相比,具有运动速度快、承载能力强的特点,而且具有仅靠重力来驱动,只 需要控制各个磁铁的通电顺序就可以实现球形机器人的运动,具有驱动少、控制简单的优 势。另外,球形机器人造型新颖别致,行动灵活,几乎没有死角,转弯半径很小,可以轻易的 实现转弯半径接近零的原地自旋转弯;其球形结构可以自由地向任何方向旋转实现全方位 滚动行走,所以对球形机器人来说所有的位置都是稳定的;在球形机器人执行未知环境探 测等任务的过程中,当与障碍物或其他运动机构发生碰撞时,球形结构具有较强的自我恢 复能力,球形的外壳也使机器人能够轻易滚过粗糙的地形。同时,由于球体滚动点接触的阻 力相对滑动或轮式装置的线接触的运动阻力小得多,所以球形机器人还具有运动效率高、 能量消耗小的优点。
Claims (10)
1.一种电磁驱动式球形机器人,其特征在于,包括球体支架、主控制器和蓄电池,球体 支架包括若干空心容腔(1)以及用于将空心容腔(1)连接成球体支架的空心管道(5),空心 管道(5)内部均放置有若干可滚动的小球,小球能够被电磁铁吸引,空心容腔⑴包括上下 两个腔体,上腔体中设置有电磁铁,下腔体用于容纳小球,下腔体与空心管道(5)形成相通 的空腔作为小球的运动通道,每个空心容腔(1)中均设置有磁力传感器,球体支架内部固定 设置有位置传感器、速度传感器、主控制器和蓄电池,磁力传感器、位置传感器、速度传感 器、主控制器和蓄电池均与主控制器通信连接。
2.根据权利要求1所述的一种电磁驱动式球形机器人,其特征在于,还包括设置在球体 支架中的三自由度云台,三自由度云台包括俯仰轴⑺、方位轴⑵和滚转轴⑻,俯仰轴(7) 包括空腔(n),和穿过空腔(71)的转动轴,转动轴一端与电机(¾的输出轴连接,另一端通 过俯仰轴座⑹与空心容腔(1)连接,空腔(71)通过方位轴⑵与半球体支架(10)联通,半球 体支架(10)中设置有滚动轴(8),滚动轴(8) —端伸出半球体支架(10),且伸出半球体支架 (10)的一端与相机架⑼固定连接,空腔(71)中设置有方位电机,方位电机的输出轴与转动 轴垂直,方位电机用于驱动半球体支架(10)进行圆周运动,半球体支架(1〇)中设置有同时 垂直于俯仰轴⑺和方位轴⑵的滚转电机。
3.根据权利要求2所述的一种电磁驱动式球形机器人,其特征在于,方位电机与方位控 制驱动模块连接,电机(3)与俯仰驱动控制模块连接、滚转电机与滚转驱动控制模块连接, 方位控制驱动模块、俯仰驱动控制模块和滚转驱动控制模块均与主控器连接。
4.根据权利要求3所述的一种电磁驱动式球形机器人,其特征在于,磁力传感器用于确 定电磁铁是否工作以及当前磁铁的磁力大小并将测量到的磁力信息反馈给主控制器;位置 传感器用于确定当前球形机器人以及三自由度云台的位置并将位置信息反馈给主控制器; 速度传感器用于测量球形机器人的运动速度并将速度信息反馈给主控制器;主控制器用于 接收磁力传感器、位置传感器以及速度传感器传递的信息,并根据接收到的信息判断机器 人运动轨迹是否为设定的轨迹,然后根据判断结果向蓄电池、方位控制驱动模块、俯仰驱动 控制模块和滚转驱动控制模块发出控制信号、以控制源给电磁铁的通、断电蓄电池的时机, 以及三自由度云台中各个电机的工作状态,使机器人的运动轨迹保持不变且三自由度云台 始终保持给定的初始姿态。
5.根据权利要求1所述的一种电磁驱动式球形机器人,其特征在于,球体支架包括26个 空心容腔(1),26个空心容腔⑴中有8个含有3个空心管道连接口,18个含有4个空心管道连 接口,含有3个空心管道连接口设置在是斜向45度方向,9个含有4个空心管道连接口均匀设 置在球体支架的最大圆环上,另外9个含有4个空心管道连接口形成的均匀设置在球体支架 的另一个半径最大的圆环上,上述两个圆环相互垂直。
6. 根据权利要求1所述的一种电磁驱动式球形机器人,其特征在于,所述蓄电池为锂离 子蓄电池。
7. 根据权利要求6所述的一种电磁驱动式球形机器人,其特征在于,每个空心容腔(1) 中均设置有锂离子蓄电池,每块锂离子蓄电池与和与其位于同一空心容腔(1)的电磁铁连 接,所有的锂离子蓄电池通过导线与主控制器连接。
8. 根据权利要求6所述的一种电磁驱动式球形机器人,其特征在于,锂离子蓄电池设置 在俯仰轴⑺的空腔(71)中,锂离子蓄电池的输入端与主控制器连接,设置与电磁铁数量相 同数量的输出端分别连接至不同的电磁铁。
9.一种电磁驱动式球形机器人的控制方法,其特征在于,包括以下步骤: 步骤1,设定机器人的运动轨迹和运动速度,以及机器人上摄像装置的初始位置; 步骤2,机器人上设置的传感器测量机器人和摄像装置的位置信息、速度信息,并将测 量到的信息传递给主控制器,主控制器根据接收到的信息,计算机器人转过的角度,并根据 计算结果对摄像装置的位置进行校正,使摄像装置保持初始视角,同时判断机器人的是否 在设定的轨迹上运动,若在设定的轨迹上则不动作,若不在设定的轨迹上,发送控制信号至 蓄电池,通过蓄电池给予电磁铁电流的大小控制机器人的运动轨迹。
10.根据权利要求9所述的一种电磁驱动式球形机器人的控制方法,其特征在于,摄像 装置设置在具有三个自由度的装置上,主控制器通过控制设置在具有三个自由度的装置上 的驱动控制模块和电机实现对摄像装置位置的控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711079875.5A CN107891416A (zh) | 2017-11-06 | 2017-11-06 | 一种电磁驱动式球形机器人及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711079875.5A CN107891416A (zh) | 2017-11-06 | 2017-11-06 | 一种电磁驱动式球形机器人及其控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107891416A true CN107891416A (zh) | 2018-04-10 |
Family
ID=61804150
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711079875.5A Pending CN107891416A (zh) | 2017-11-06 | 2017-11-06 | 一种电磁驱动式球形机器人及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107891416A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108716636A (zh) * | 2018-05-29 | 2018-10-30 | 东莞市闻誉实业有限公司 | 导管动态光源 |
CN109027862A (zh) * | 2018-05-31 | 2018-12-18 | 东莞市闻誉实业有限公司 | 动态有序发光结构 |
CN109062200A (zh) * | 2018-07-19 | 2018-12-21 | 杭州电子科技大学 | 一种定位传感器节点的移动机器人滚动时序控制方法 |
CN109084241A (zh) * | 2018-06-13 | 2018-12-25 | 东莞市闻誉实业有限公司 | 发光转筒结构与装饰灯 |
WO2020000853A1 (zh) * | 2018-06-26 | 2020-01-02 | 清华大学 | 一种自驱动行走机器人及其控制方法 |
CN112863805A (zh) * | 2021-01-07 | 2021-05-28 | 华中科技大学 | 可编程点阵磁场控制系统 |
-
2017
- 2017-11-06 CN CN201711079875.5A patent/CN107891416A/zh active Pending
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108716636A (zh) * | 2018-05-29 | 2018-10-30 | 东莞市闻誉实业有限公司 | 导管动态光源 |
CN109027862A (zh) * | 2018-05-31 | 2018-12-18 | 东莞市闻誉实业有限公司 | 动态有序发光结构 |
CN109084241A (zh) * | 2018-06-13 | 2018-12-25 | 东莞市闻誉实业有限公司 | 发光转筒结构与装饰灯 |
WO2020000853A1 (zh) * | 2018-06-26 | 2020-01-02 | 清华大学 | 一种自驱动行走机器人及其控制方法 |
CN109062200A (zh) * | 2018-07-19 | 2018-12-21 | 杭州电子科技大学 | 一种定位传感器节点的移动机器人滚动时序控制方法 |
CN109062200B (zh) * | 2018-07-19 | 2021-06-29 | 杭州电子科技大学 | 一种定位传感器节点的移动机器人滚动时序控制方法 |
CN112863805A (zh) * | 2021-01-07 | 2021-05-28 | 华中科技大学 | 可编程点阵磁场控制系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107891416A (zh) | 一种电磁驱动式球形机器人及其控制方法 | |
CN105397795B (zh) | 一种轨道式巡检机器人 | |
CN105947006B (zh) | 一种球形机器人及控制方法 | |
CN206825420U (zh) | 一种智能安防机器人 | |
CN106005080B (zh) | 一种具有跳跃避障功能的作物底层茎秆巡检球形机器人 | |
CN207406986U (zh) | 一种管道机器人 | |
CN104155976B (zh) | 自主式球轮移动机器人及其控制方法 | |
CN104527352A (zh) | 一种新型球形两栖机器人及其工作方法 | |
CN105605984B (zh) | 一种打靶机器人及其实现方法 | |
CN107127745A (zh) | 一种智能安防机器人 | |
CN103085955A (zh) | 一种仿海龟四鳍拍动式自主水下机器人 | |
CN106383519A (zh) | 一种机器人自主定位充电系统及方法 | |
CN106774298B (zh) | 基于摄像头与激光引导定位的机器人自主充电系统及方法 | |
CN205345105U (zh) | 摩擦式内驱动全方位球形机器人机构 | |
CN106828643A (zh) | 一种全方向运动球形机器人 | |
CN107139176B (zh) | 一种蛇形机器人位姿控制系统及方法 | |
CN207127871U (zh) | 一种可避障碍的机器人 | |
CN103904953A (zh) | 一种全方向自由移动装置 | |
CN211827023U (zh) | 一种电缆隧道环境全方位监测机器人 | |
CN207225605U (zh) | 一种无人机停靠平台 | |
CN105730538A (zh) | 摩擦式内驱动全方位球形机器人机构 | |
CN207534823U (zh) | 一种球形安防机器人 | |
CN207292187U (zh) | 用于环境探测的球形移动机器人 | |
CN206193537U (zh) | 履带机器人自主定位充电系统 | |
CN208393509U (zh) | 一种智能步行机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |