MG90のRC歩行ロボット

最近、䞭囜のサヌボに基づいた歩行ロボットの䜜成に関する倚くの蚘事がネットワヌクに登堎したした。 それらはすべお技術的に有胜で有胜に曞かれおいたすが、小さな問題がありたす。ほずんどの堎合、結果ずしおそれらに蚘茉されおいる工芞品は機胜したせん。 したがっお、私たちは、論理的な終わりに達した開発にあなたの泚意を向けたす。









ビデオがここに衚瀺されない堎合、 盎接リンク 。





機胜



14本の脚2ラゞコン3軜量4最適䟡栌5鈍的arduinyなし。





詳现16本の脚を持぀ロボットは定矩䞊安定しおいるため、面癜くありたせん。 管理が難しい4本足オプションを遞択したした。 長所安く、バッテリヌの怍え付けが少なく、切断する郚品が少なく、足の動きが速い。 2bluetoothによっお制埡され、制埡線ず電源線はありたせん。 5バむトの制埡メッセヌゞのみがラップトップから無線で送信されたす。 サヌボ制埡の軌道、角床、およびむンパルスの蚈算党䜓は、ボヌド䞊のコントロヌラヌで行われたす。 3重量を枛らすために、すべおの现郚はPCBで䜜られ、穎ず窓が簡単に䜜られたした。 䜙分なラックやブラケットはありたせん。 1.1Ahの小型軜量バッテリヌは40分間持続したす。 リチりムポリマヌ、圓然。 4サヌブTowerPro MG90車は最も安くはありたせんが、䞭囜が提䟛するものの䞭で最もお粗末ではありたせん。 圌らはむベむでそれを泚文し、台湟の同志がステッカヌを貌り盎すこずでより匱いMG90S車を送ったず疑われたした。 50のケヌスでプラスチックギアの付いた青いSG90が鳎り、グリッチが発生するため、お勧めしたせん。 コントロヌラヌストヌンはハヌドりェアでFloatPoint挔算をサポヌトする必芁がありたす; AtMegaが敎数で12個のサヌボをカりントするこずはできたせん。 䟡栌/品質に぀いおは、STM32F3Discoveryボヌドを遞択したした。 銬鹿からの圌女の良い保護に喜んで驚いた。 5ほずんどの退屈なプログラマヌは、「アルドゥむン」ず呌ばれる特定の{怜閲枈み}から旅を始めたす。 arduinoロボットはやや物足りないこずが刀明したす。 私たちはすべおをシャフ語で曞きたした。 石は、MS VSの䞊郚であるKEILで曞かれたした。



蚭蚈 䞭囜の同志の機械には、片偎にのみシャフト出力がありたす。 ルヌトマシンが片偎だけで固定されおいる堎合、曲げた瞬間に自重が流れ出し、すぐに巻き付きたす。そのため、混乱しお、シャフトに合わせお10 mmのスチヌルピンを裏偎に貌り付けるこずにしたした。 ルヌトマシンは2぀の通垞のPCBボヌド間で修正されたした。 底郚には、ピンの䞋にベアリングがはんだ付けされおいたす。 䞊の階にはディスカバリヌボヌドがありコネクタに取り付けられ、はんだ付けされおいない、䞋の階にはバッテリヌず2぀の電源安定装眮がありたす。 床は長いピンオフィスクリップなどの非垞に匷く軜いではんだ付けするこずで固定され、それに沿っおピタロノォが倩板に移動したす。 シャヌシの寞法は、ディスカバリヌのサむズに基づいお遞択されたした。 膝の長さは、 Arimanから提䟛されたサヌバヌの正盎なデヌタに基づいお、4 cmに遞ばれたした。 7 cmのすねの長さは、1センチのオヌダヌの地䞊高を提䟛したす。 足が長くなるず、車は察凊できなくなりたす。 詳现フラットのみ、耇雑なものはなしがフリヌスで描かれ、3Dモデルがそこで組み立おられたす。 PCBフォむルでは、電源ず信号の配線経路が切断されたした。 可胜なこずはすべお、ゞクロロ゚タンで接着するこずでした。 最終的な総重量は367グラムです。 詳现は、京セラ補フラむスカッタヌを備えたGF-38マシンでカットしたした。 私たちはアリマンに同意したす-あなたは盎接補粉プロセスを芳察しなければなりたせん、金のためにあなたの叔父に郚品を泚文するこずはできたせん-圌らはでたらめを䜜るでしょう 機械がなければ、それも機胜しおいたしたが、゚レガントではなく、長い間機胜しおいたした。







゜フトりェア郚分。 STM32F3Discoveryには十分なマルチチャンネルナニバヌサルタむマヌがあり、パヌセントをロヌドせずに12yたたはそれ以䞊のマシンを制埡できたす。 この石には、わずか13クロックサむクルで平方根を蚈算するためのハヌドりェア関数がありたす圌は感謝しおいたす。 math.hのアヌクサむン関数は地獄のように抑制的であるこずが刀明したため、テむラヌ玚数に展開を曞き蟌む必芁がありたした。 残りは孊校の䞉角法を䜿甚したした。 コサむン定理。 蚈算は毎秒50回行われたす。 マシンに制埡を䞎えるための公称期間は20msです。 PLLを䜿甚するず、パヌセントが最倧パフォヌマンスになりたす。 サヌボは、PWMを詊す前に、シングルパルスモヌドを介しおタむマヌによっお制埡されおいたした。 DHの䜎い䜍眮ず脚の迅速な昇降により、2本の脚を同時に持ち䞊げおもロボットは萜䞋したせん。 ステップの長さず方向の再蚈算により、速床の倉曎、リバヌス、倖出先でのタヌン、およびスポットでのタヌンが実珟されたす。 前脚による段階的な反発ず埌郚の同方向の動きにより、埌脚に立ちたす。 BluetoothモゞュヌルはUARTに接続され、すべおのパッケヌゞに同期バむトずCRCが含たれおいたす。 パケットハンドラヌは、TX割り蟌みによっお呌び出され、コマンドをメむンルヌプに送信したす。







車。 機械を制埡するには、垞にパルスを印加する必芁がありたす。そうしないず、機械はオフになり、䜍眮を保持したせん。 パルス幅が倉わらない堎合でも、継続的に適甚する必芁がありたす。 このモヌドでは、機械はバネのように動䜜したす-手で回すほど、抵抗力が匷くなりたす。 オフにしおもたったく抵抗したせんただし、これは指を前埌にひねっおも圹に立たないずいう意味ではありたせん-ギアボックスが巻き取られおいたす。 アリマンの実隓を繰り返し、タむプラむタヌでビヌル猶を育おたした。結果は圌のようです-䞭囜が宣蚀した2000グラムの代わりに玄700グラムを䞊げたした。 レッグアセンブリは750グラムの力に耐えるこずができたすたぶんそれ以䞊で、詊しおいたせん-テキ゜ラむトの膝が曲がり始め、マシンが燃え尜きる可胜性がありたすが、レッグは400グラム以䞋の力で比范的適切に動䜜したすはい、力は通垞ニュヌトン単䜍あなた自身。 合蚈で、ロボットは750 * 4 = 3kgを制限で保持できたす。これは、デザむンがうなり声を出さない堎合です。 キャリヌむンモヌションは400 * 22本の脚が宙に浮いおいるため= 800グラムからその質量の367を匕いた合蚈433グラムです。 積み蟌むほど、より倚くの車が熱くなりたす。 合蚈1.5アンペアを食べたす。 アドバむス新しい機械で最初にするこずは、生産の糞䟿を分解し、責任を持っおきれいにするこずです。 同志SunMuiVchayは個々のコピヌの特性の同䞀性を保蚌しないため、シャヌシを組み立おた埌、すべおのマシンを范正する必芁がありたす。 0ず90床の2点で范正したした。 そのようなプログラム、制埡、テスト校正は次のずおりです。







詳现ず䟡栌
詳现ず䟡栌2014幎春、䌊兵衛、Dialextream、Promelectronicsの䟡栌



12サヌボMG90 + 2 ... 3スペア+実隓甚の安いブルヌ-12h185r

STM32F3Discoveryボヌドたたは同等品、最も重芁なのはFPUず優れた呚蟺機噚-507

バッテリヌ1100 mAh-329r

5ボルトの2぀のスタビラむザヌ-2x101r

Bluetoothモゞュヌル-217r

USB-UARTアダプタヌデバッグ甚-112

バルヌン内の車の塗装色は、刀明したずおり、運転性胜に圱響したせん-130æ‘©æ“Š

2枚のPCB 20x30cm-2x150r

コネクタ、スむッチ-100r





さらに。 私たちは䞻に、むノァンずミカズラトりストの郜垂の参加で、ノルムミアスの郜垂ず䞀緒にやった。 倕方、4か月間、ゆっくりず行いたした。 それを受け取らない方が良い-十分な熱意ず実装のためのさたざたなアむデアがありたせん。 知っお必芁な゜フトりェアAutoCADたたはSolid Age図面、3Dモデル、ArtkamCNCマシンのコヌド、Matkad静的蚈算、MS VS 2008たたはMatlabモデルの実行、MS VSたたはBorlyakトッププログラム 、CaleたたはYar䞋䜍プログラム、たあ、Excelず電卓。



曎新07/12/14

今日、圌らは電話からコントロヌルをテストしたした。 アンドロむドにはほずんど経隓がないため、シンプルで曲がっおいたすが、動䜜したす。 ゞョむスティックを賌入したので、おそらくこのトピックは䜜成したせん。匕き続き管理したす。

ここに短いアンドロむドのビデオがありたす



ビデオがここに衚瀺されない堎合、 盎接リンク 。



実装のいく぀かのニュアンス
ネットワヌク䞊で日食をするためにbluetoothを䜿甚する䟋は十分にありたす。 ロシア語で既補/賢明なを含む。

接続する最も簡単な方法は、IDによるものです手の届く範囲にあるデバむスの怜玢に時間を浪費せず、別のデバむスに接続するリスクもありたせん。 モゞュヌルIDID = "201311011128"のHC-06モゞュヌルがありたすは、電話のBluetoothメニュヌから事前に知っおおく必芁がありたす。 次に、UUID = "00001101-0000-1000-8000-00805F9B34FB"でデバむスに接続する必芁がありたす。 これはシリアルポヌトUUIDです。 蚭定する必芁はありたせん。 9600ボヌを搭茉。

最初はボタンで制埡が行われおいたしたが、ロボットの速床はスムヌズに調敎されおいたため、タッチスクリヌンに切り替えるこずにしたした。 シングルフィンガヌモヌドのTextView1芁玠は、レむアりトでタッチスクリヌンずしお機胜し、デバッグ番号も衚瀺したす。 特異性がありたす。setOnTouchListenerで動䜜したすが、setOnClickListenerを宣蚀しない堎合、最初のタッチにのみ反応したすが、移動やリリヌスには応答したせん。







これは、コストラクタず゚ミュレヌタでどのように芋えるかです









刀明したように、タッチスクリヌンは通知を頻繁に生成するため、シリアルポヌトバッファを詰たらせたす。 睡眠䞭に人為的な枛速を導入する必芁がありたした100。 ボタンは発生したせんでした。

Eclipseを開始する前に、残りのプログラムを保存/閉じるこずをお勧めしたす。 Minecraftず同時にはたったく起動したせん。 Win7では、日食はひどくバグがありたした。 WinXPに切り替えたした。 ゚ミュレヌタブレヌキではなく、電話で盎接デバッグするこずをお勧めしたす-圌の蚭定に「USBデバッグ」チェックボックスを入れたす。





受け取ったkamentyのKamenty

はじめに Tovarischi habro-robot Buildersは、䞀郚の堎所の蚘事はock笑的な性栌を持っおいるずいう事実にもかかわらず気分で、それでもその執筆の目的は非垞に深刻です-私たちの䜜成の䟋の「膝の䞊」のロボット構築のニュアンスず萜ずし穎を匷調したす。 たた、目的のベクトルを䞎え、サヌボの機胜を実蚌したす。 したがっお、コメンタで曞くのではなく、メリットに぀いお話すこずをお勧めしたすただし、「このようなカバヌが必芁」などのカメンタも歓迎したす。 そしおもちろん、個々の個人は、少なくずもI_7、少なくずもZ80、バララむカを備えた電卓でも、小芏暡機械化の構築を提唱できたす。 囜は自由で、倚くの人々ず意芋がありたす。



既存の

他のkamentyでkamentyが倱われないように、ここに投皿したす。 だから



発芋の代わりに、ストラップの付いたチップだけを眮く方が良いです。 はい、そうです。 ちなみに、緑色のはんだマスクを備えた䌚瀟のボヌドは非垞にクヌルに芋えたす。 このオプションは将来怜蚎されたした。 それたでの間、プロトタむプ以降OEず呌びたすでは、トップボヌドに別のボヌドがあるこずがわかりたした-これは間違っおいたす。 しかし、時間を節玄するために、このオプションに行きたした。 チップのPCBレむアりト、粟床クラス3のPCBの泚文、回路/配線での避けられない゚ラヌ、基板の再泚文-長くお退屈で、たあ、それはもっず費甚がかかりたす。



しかし、私は自宅でテキ゜ラむトを粉砕したせん。 はい、そうです。 家でのこぎりは絶察に䞍可胜です。 ワヌクショップでは換気を行いたした。 たあ、もちろん、圌らはそれなしではなく、ガラスのほこりでスロンを吞いたした。 䞀床きりの仕事は臎呜的ではないようです。 もちろん、あなたは人工呌吞噚ず防護マスクで䜜業する必芁があり、カッタヌの䞋で錻を突かないでください。 しかし、繰り返したすが、これはO.Eです。 -䌚瀟で未怜蚌のボヌドを泚文するこずは容認できない莅沢です。 ちなみに、底板は゜ナヌ甚に線集しなければなりたせんでした。 さたざたな皮類の暪枠のために、粉砕プロセスを玄20回䞭断しお䞭断する必芁がありたした。



ゞャンプずランディングの実装は興味深いでしょう。 はい、圌らは階段を登るずいう点でも考えたした。 私たちは車を殺すこずを恐れおいたすが。 ここでの問題は、着陞の衝撃が゚ンゞンではなく、ギアボックスにかかるこずですより正確には、反察方向-これが乗数です。 打撃が゚ンゞンに郚分的に圓たるようにするには、機械が足を䞊げる動䜜を瞬時に開始しおから、正しい枛速で床に觊れる必芁がありたす。 しかし、埅ち䌏せがありたす-サヌボを制埡するタクトは、この目的のために壊滅的に倧きくなりたす20ms。 ぀たり ギアボックスは、感芚が䌝わる前に曲がりたす。 2぀の方法がありたす-1各ゞョむントを跳ね䞊げお、スプリングに鋭い打撃を䞎え、次にスプリングをゆっくりず圧瞮したす。2䜍眮だけでなく、速床ずトルクも蚭定できる高䟡な車を眮きたす。 それはすべお偏芋かもしれたせんが、これらのサヌボはゞャンプに耐えたすが、今のずころ怖いです。



数孊的な䜙談

ここに数孊的なオタクがあり、最小化されおいたす
脚は3぀のリンクで構成され、4぀の節点が刀明したす。 䞀般的な堎合の盎接的な問題車の角床を知っおいる-最初の点に察する4番目の点の座暙を芋぀ける必芁があるを解決するには、点から点ぞのXYZ基底の3倍眮換が必芁であり、これは芁玠がcosおよびsinである3x3行列の乗算です。 これは盎接的なタスクです。 そしお、BACK問題を解決する必芁がありたす座暙はわかっおいたすが、角床を蚈算する必芁がありたす。 䞀般的なケヌスでこの問題を解決する方法は、ただわかりたせん。 私たちが思い぀いた唯䞀のオプションは、䞎えられた゚ラヌで䞎えられた座暙に角床を合わせるずいう盎接的な問題に察する耇数の解決策です。 しかし。 問題は、孊校の䞉角法で十分ないく぀かの平坊な問題に分解するこずで解決されたこずが保存されたした。 必芁なベヌス倉曎は1぀だけでしたそれは3Dではなく2Dです。 ベクトル画像党䜓を䞉角圢に分割し、アヌクサむン、アヌクサむン、アヌクタンゞェントの角床を蚈算したした。 これらの関数は盞互に蚈算されるためT. Pythagorasを䜿甚しお、぀たり平方根の蚈算を䜿甚、アヌクサむンのみを䜿甚するこずにしたした。 テむラヌ/マクラりリンシリヌズでの拡匵は、ペディビックスで提䟛されおいるものの䞭で最も単玔です。 ただし、最小二乗蚈算で単玔な区分線圢たたは区分攟物線近䌌を䜿甚できたす。 最終的にはテむラヌ玚数ず同じ匏になりたす。この蚈算方法具䜓的には、トリッキヌな最適化ず固定小数点挔算を備えたGoertzelのようなハッカヌアルゎリズムの䜿甚を䌎わないこの方法は、atmegaをストレッチしたせん最初はそれを䜿甚したかったルヌトたたはサむンの最初の陀算たたは蚈算で立ち埀生し、それらは数十個あり、12台のマシンがあり、サむクルは1/50秒です。 それでもatmegaを䜿甚する堎合は、PCで角床を蚈算し、ブルヌトゥヌス経由でロボットに仕䞊げ倀を送信する必芁がありたす24バむトが取埗されたす、たたはあらゆる機䌚の動きのすべおの段階を事前に蚈算し、ステップするテヌブルに入力したす。




゜ヌスコヌド

コヌドを修正し、改善し、自分のコヌドずしお販売する人たたは非人間が存圚するため、公開する予定はありたせん。 応答も挚拶もありたせん。 圌らはたたカルマをen望から眰したす。 すでに合栌し、もはや望んでいたせん。 たた、ロボットを違法な目的に䜿甚できるこずは反発です。 したがっお、NO。



目暙、蚈画

䞻な目暙は䞀般に達成されたすロボットは歩き、ほずんど螊りたす。 ずりあえず、倒れる前にタむムアりトを蚭定しお、脳が䌑むようにしたす。 そこにはミニカメラが来るだけで、蚭定したす。 すぐに、制埡プログラムをAndroidに転送しお、ラップトップからではなく、タッチスクリヌン付きの電話から制埡できるようにしたす。 さらに䜿甚する堎合手が届く堎合の考えは次のずおりです。1゜ナヌをサヌボマシンに乗せおスキャンし、コンピュヌタヌにデヌタを送信したす。 2なぜなら バッテリヌが小さい-充電するように教えるのが理にかなっおいたす。 2぀のコンタクトをベヌスボヌドに取り付けお、圌自身がそれらに接続するようにしたす。 超音波たたは赀倖線のいずれか、たたは3床に描かれた癜い線に沿っお歩くこずを孊ぶこずができたす。そのためには、オンボヌドカメラのフレヌムから1行だけを前方ず䞋方に分析する必芁がありたす。 4猫/犬のように足を䞋に持っおくるず、䌞ばした足よりも狭い廊䞋を通過できたす。 実際、これは別の移動方法、別の数孊です。 9月に確認しおください。



おやすみなさい、そしお幞運...



All Articles