設為首頁收藏本站
開啟輔助訪問 切換到寬版

Robofun 機器人論壇

 找回密碼
 申請會員
搜索
熱搜: 活動 交友 discuz
Robofun 機器人論壇»論壇 › 個性機器人區 › Roboard 安東尼小主版 › Roboard 的 PWM 好像會干擾?
12下一頁
返回列表 發新帖
查看: 6850|回復: 24

Roboard 的 PWM 好像會干擾?

[複製鏈接]
miaoichi
發表於 2012-1-8 17:29:45 | 顯示全部樓層 |閱讀模式
以下範例程式是輸入要執行的pin,channel, period, duty 來控制某一個pwm
但是一執行，很多其他的pwn好像也都會有信號送到其他馬達，
請問是哪裡有問題?是軟體還是硬體?




  3. int main(int argc, char **argv)
  4. {
  5. int i;
  6. roboio_SetRBVer(RB_100;
  7. for(i=RCSERVO_PINS1;i<=RCSERVO_PINS24;i++) //只初始 1~4 , 11~24的pwm
  8. if(i<RCSERVO_PINS5 || i>RCSERVO_PINS10)
  9.     rcservo_SetServo(i, RCSERVO_SERVO_DEFAULT_NOFB); // select the servo model as non-feedback servo
  10. if (rcservo_Init(RCSERVO_USEPINS1TO24) == false) // set PWM/GPIO pin 1~4 , 11~24 as Servo mode
  11. {
  12. printf("ERROR: fail to init RC Servo lib (%s)!\n", roboio_GetErrMsg());
  13. return -1;
  14. }

  16. rcservo_EnterPWMMode(); // make all servo-mode pins go into PWM mode
  17. printf("Send PWM pulses of period %ldus duty %ldus on pin %d...\n",period,duty,channel+1);
  18. rcservo_SendCPWM((atoi(argv[1]) - 1),atol(argv[2]),atol(argv[3]));
  19. printf("Press ENTER to stop.\n"); getchar();
  20. rcservo_StopPWM(channel);
  21. rcservo_Close(); // close RC Servo lib
  22. }
複製代碼
回復

舉報

mzw2008
發表於 2012-1-8 23:28:17 | 顯示全部樓層
咦?! 是說給這三個參數去控制某馬達
結果其他的也一起動?
上面的程式看起來不會耶

那些被干擾的馬達也動到一樣的位置?!
回復 支持 反對

舉報

mzw2008
發表於 2012-1-8 23:30:37 | 顯示全部樓層
rcservo_StopPWM(channel);
channel 這個變恕宣告在哪裡? 怎麼沒看到呢?
回復 支持 反對

舉報

miaoichi
 樓主| 發表於 2012-1-10 21:57:32 | 顯示全部樓層
本帖最後由 miaoichi 於 2012-1-10 21:59 編輯

感謝m大幫忙，我把程式重貼了，請幫我再看一下。謝謝



  3. int main(int argc, char **argv)
  4. {
  5.     roboio_SetRBVer(RB_100);// first set the correct RoBoard version
  6.     if(InitServo())
  7.        return -1;
  8.     if(argc == 4)
  9.    {
  10.        BodyServoDrive((atoi(argv[1]) - 1),atol(argv[2]),atol(argv[3]));
  11.        return 0;
  12.     }
  13.     else if(argc == 3)
  14.    {
  15.         rcservo_OutPin((atoi(argv[1]) -1), atoi(argv[2]));
  16.     }
  17.     else
  18.    {
  19.         printf("input example-- %s channel period duty \n",argv[0]);
  20.         printf("channel : from 1 to 19 \n");
  21.         printf("period 10ms => 10000\n");
  22.         printf("duty 1500us => 1500\n");
  23.     }

  25.     return -1;
  26. }



  30. int InitServo(void)
  31. {
  32.      int i;
  33.      for(i=RCSERVO_PINS1;i<=RCSERVO_PINS24;i++)
  34.      if(i<5 || i>10)
  35.            rcservo_SetServo(i, RCSERVO_SERVO_DEFAULT_NOFB);     // select the servo model as non-feedback servo
  36.      if (rcservo_Init(RCSERVO_USEPINS1TO24) == false)  // set PWM/GPIO  as Servo mode
  37.     {
  38.         printf("ERROR: fail to init RC Servo lib (%s)!\n", roboio_GetErrMsg());
  39.         return -1;
  40.     }
  41.     return 0;
  42. }

  44. void BodyServoDrive(int channel, long period, long duty)
  45. {
  46.     rcservo_EnterPWMMode();  // make all servo-mode pins go into PWM mode
  47.     printf("Send PWM pulses of period %ldus duty %ldus on pin %d...\n",period,duty,channel+1);
  48.     rcservo_SendCPWM(channel, period, duty);
  49.     printf("Press ENTER to stop.\n"); getchar();
  50.     rcservo_StopPWM(channel);
  51.     rcservo_Close();  // close RC Servo lib
  52. }





複製代碼
回復 支持 反對

舉報

miaoichi
 樓主| 發表於 2012-1-10 22:02:59 | 顯示全部樓層
有用到的pwm 共18個
PWM1 -> Servo
PWM2 -> Servo
PWM3-> Servo
PWM4-> Servo
PWM11-> Servo
PWM12-> Servo
PWM13-> Servo
PWM14-> Servo
PWM15-> Servo
PWM16-> Servo
PWM17-> Servo
PWM18-> Servo
PWM19-> Servo
PWM20-> Servo
PWM21-> Servo
PWM22-> Servo
PWM23-> Servo
PWM24-> Servo
回復 支持 反對

舉報

roboardgod
發表於 2012-1-12 11:53:02 | 顯示全部樓層
請教下...
rcservo_Init(RCSERVO_USEPINS1TO24)
裡面的RCSERVO_USEPINS1 TO 24 這個您是從哪找到的??
因為我沒看過這東西...

然後你的問題[很多其他的pwm好像也都會有信號送到其他馬達]
是怎樣的情況?

*已測試過兩顆RS-0263馬達  未出現你說的情況...
回復 支持 反對

舉報

mzw2008
發表於 2012-1-12 14:15:10 | 顯示全部樓層
哈哈
RB魔人出現了
而且有很壯觀的新辦公室耶XD
回復 支持 反對

舉報

roboardgod
發表於 2012-1-12 16:24:59 | 顯示全部樓層
本帖最後由 roboardgod 於 2012-1-12 16:34 編輯
哈哈
RB魔人出現了
而且有很壯觀的新辦公室耶XD
mzw2008 發表於 2012-1-12 14:15


既然已經被鯨魚大大注意到了, 本魔就順便自介一下吧!

自介:


稱號: RoBoard魔人(還是隻嫩魔而已啦)

等級: RoBoard初學者, 機器人菜鳥

職業: DMP象牙塔小書僮

目標: 成為RoBoard神人

夢想: 用RoBoard控制BigDog


本魔受 DMP 象牙塔上焚書坑儒的萬惡罪魁──藏鏡人指示, 專門來此地服務 lu 大, 幫忙解答關於 RoBoard 的技術問題！


本魔目前大二，剛開始進入RoBoard與機器人的領域學習, 知識層面或許有很多不足的地方, 不足之處未來還請版上諸位大大不吝指導！


lu 大, 我來拜碼頭啦! 以後本魔萬一在版上搞出笑話, 還要請您多罩一下囉!
回復 支持 反對

舉報

roboardgod
發表於 2012-1-12 16:27:21 | 顯示全部樓層
順便預告: 等 lu 大進駐新總部, 我會代替大家採訪 lu 大的高級專屬辦公室喔!
敬請期待~~
回復 支持 反對

舉報

lakers3411
發表於 2012-1-12 17:37:56 | 顯示全部樓層
用rb控制bigdog好像不太好喔
黑道大哥會不爽

(小聲)他都很常來偷看喔,快改成控制老戴一號吧~
回復 支持 反對

舉報

miaoichi
 樓主| 發表於 2012-1-12 23:16:55 | 顯示全部樓層
本帖最後由 miaoichi 於 2012-1-12 23:21 編輯
請教下...
rcservo_Init(RCSERVO_USEPINS1TO24)
裡面的RCSERVO_USEPINS1 TO 24 這個您是從哪找到的??
因 ...
roboardgod 發表於 2012-1-12 11:53


歹勢，這是我寫的但是我忘了貼上去。

    #define RCSERVO_USEPINS1TO24 (RCSERVO_USEPINS1+RCSERVO_USEPINS2+RCSERVO_USEPINS3+RCSERVO_USEPINS4+RCSERVO_USEPINS5+RCSERVO_USEPINS6+RCSERVO_USEPINS7+RCSERVO_USEPINS8+RCSERVO_USEPINS9\
+RCSERVO_USEPINS10+RCSERVO_USEPINS11+RCSERVO_USEPINS12\
+RCSERVO_USEPINS13+RCSERVO_USEPINS14+RCSERVO_USEPINS15+RCSERVO_USEPINS16\
+RCSERVO_USEPINS17+RCSERVO_USEPINS18+RCSERVO_USEPINS19+RCSERVO_USEPINS20\
+RCSERVO_USEPINS21+RCSERVO_USEPINS22+RCSERVO_USEPINS23+RCSERVO_USEPINS24)



我的問題是我把18個馬達都接上去，然後用我自己寫的程式去一個一個下command控制，
例如: sudo ./hexapod.exe 1  10000   1500
                ./hexapod.exe channel   period    duty

但是一執行下去，其他的馬達也會跟著亂動。
回復 支持 反對

舉報

mzw2008
發表於 2012-1-13 00:02:08 | 顯示全部樓層
原來是這樣寫...
其實那些常數剛好都是2的整數次方, 直接用迴圈跑次方相加也是可以

剛剛心血來潮亂接了20顆(11顆MG995/祥儀的兩顆/7顆RS1270, 供三種不同電壓)
然後亂數送資料他也不會亂動耶
你是馬達都直接接RB?
還是像我一樣用共地另接電源

通通直接接RB100會有電力不穩的情況 , 馬達啟動時板子會不穩, 110因為SERVO獨立供電不會這樣
你的是100要單獨供喔
回復 支持 反對

舉報

mzw2008
發表於 2012-1-13 00:03:14 | 顯示全部樓層
既然已經被鯨魚大大注意到了, 本魔就順便自介一下吧!
自介:
稱號: RoBoard魔人(還是隻嫩魔而已啦)等級 ...
roboardgod 發表於 2012-1-12 16:24


哈哈
這種介紹好像在玩角色扮演遊戲
出場值設定嗎?
回復 支持 反對

舉報

lucrece_lu
發表於 2012-1-13 09:36:32 | 顯示全部樓層
哇  魔人駕到..... 請受小弟一拜
回復 支持 反對

舉報

roboardgod
發表於 2012-1-13 09:57:49 | 顯示全部樓層
本帖最後由 roboardgod 於 2012-1-13 09:58 編輯

m大
你先確定下你RB背面的PULL-UP/DOWN開關 有切到PULL-DOWN位置
請再進一步確認BIOS裡面 Chipset > SouthBridge Configuration > Multi-Function Port Configuration選單的Port0~2的每個Bit都有切成OUT 0


如果沒有這樣設定的話 馬達在呼叫rcservo_Init()的時候 PWM腳位可能會從1變成0  導致馬達誤認為收到pulse亂動歐
回復 支持 反對

舉報

roboardgod
發表於 2012-1-13 10:43:53 | 顯示全部樓層
本帖最後由 roboardgod 於 2012-1-13 12:34 編輯

程式有些小問題

M大的code
  1. int main(int argc, char **argv){
  2.     roboio_SetRBVer(RB_100);// first set the correct RoBoard version
  3.     if(InitServo())
  4.        return -1;
  5.     if(argc == 4)   {
  6.        BodyServoDrive((atoi(argv[1]) - 1),atol(argv[2]),atol(argv[3]));
  7.        return 0;
  8.     }    else if(argc == 3)   {
  9.         rcservo_OutPin((atoi(argv[1]) -1), atoi(argv[2]));  //你在前面InitServo()這個function就已經把所有PWM切成Servo-Mode PIN了  所以這個 GPIO-Mode PIN function :rcservo_OutPin() 在這使用會沒有效果喔~
  10.     }    else   {
  11.         printf("input example-- %s channel period duty \n",argv[0]);
  12.         printf("channel : from 1 to 19 \n");
  13.         printf("period 10ms => 10000\n");
  14.         printf("duty 1500us => 1500\n");
  15.     }
  16.     return -1;
  17. }


  20. int InitServo(void){
  21.      int i;
  22.      for(i=RCSERVO_PINS1;i<=RCSERVO_PINS24;i++)
  23.      if(i<5 || i>10)  //RCSERVO_PINS5其實不等於5喔~RCSERVO_PINS10也不等於10!   這邊建議改成 if(i<RCSERVO_PINS5 || i>RCSERVO_PINS10 ) 喔   ^^
  24.            rcservo_SetServo(i, RCSERVO_SERVO_DEFAULT_NOFB);     // select the servo model as non-feedback servo
  25.      if (rcservo_Init(RCSERVO_USEPINS1TO24) == false)  // set PWM/GPIO  as Servo mode
  26.     {
  27.         printf("ERROR: fail to init RC Servo lib (%s)!\n", roboio_GetErrMsg());
  28.         return -1;
  29.     }
  30.     return 0;
  31. }
  32. void BodyServoDrive(int channel, long period, long duty){
  33.     rcservo_EnterPWMMode();  // make all servo-mode pins go into PWM mode
  34.     printf("Send PWM pulses of period %ldus duty %ldus on pin %d...\n",period,duty,channel+1);
  35.     rcservo_SendCPWM(channel, period, duty);
  36.     printf("Press ENTER to stop.\n");
  37.     getchar();
  38.     rcservo_StopPWM(channel);
  39.     rcservo_Close();  // close RC Servo lib  //rcservo_Close()最好要放在程式結束的地方
  40. }   
複製代碼





魔人修過的code
  1. //程式使用PIN S1~S4 及 S11~S24  為Servo-Mode PIN
  2. #define USEDPINS  (RCSERVO_USEPINS1+RCSERVO_USEPINS2+RCSERVO_USEPINS3+RCSERVO_USEPINS4+RCSERVO_USEPINS11+RCSERVO_USEPINS12+RCSERVO_USEPINS13+RCSERVO_USEPINS14+RCSERVO_USEPINS15+RCSERVO_USEPINS16+RCSERVO_USEPINS17+RCSERVO_USEPINS18+RCSERVO_USEPINS19+RCSERVO_USEPINS20+RCSERVO_USEPINS21+RCSERVO_USEPINS22+RCSERVO_USEPINS23+RCSERVO_USEPINS24)

  4. int InitServo(void);
  5. void BodyServoDrive(int channel, long period, long duty);
  6. int main(int argc, char **argv)
  7. {
  8.     roboio_SetRBVer(RB_100);// first set the correct RoBoard version
  9.     if(InitServo())
  10.        return -1;
  11.     if(argc == 4)
  12.    {
  13.        BodyServoDrive((atoi(argv[1]) - 1),atol(argv[2]),atol(argv[3]));
  14.     }
  15.     else if(argc == 3)
  16.    {
  17.         if((atoi(argv[1]) -1) >=  RCSERVO_PINS5 && (atoi(argv[1]) -1) <=  RCSERVO_PINS10 )
  18.              rcservo_OutPin((atoi(argv[1]) -1), atoi(argv[2]));
  19.         }else
  20.    {
  21.         printf("input example-- %s channel period duty \n",argv[0]);
  22.         printf("channel : from 1 to 19 \n");
  23.         printf("period 10ms => 10000\n");
  24.         printf("duty 1500us => 1500\n");
  25.     }
  26.     rcservo_Close();
  27.     return -1;
  28. }

  30. int InitServo(void)
  31. {
  32.      int i;
  33.      for(i=RCSERVO_PINS1;i<=RCSERVO_PINS24;i++)
  34.           if(i< RCSERVO_PINS5 || i> RCSERVO_PINS10 )
  35.                 rcservo_SetServo(i, RCSERVO_SERVO_DEFAULT_NOFB);     // select the servo model as non-feedback servo
  36.      if (rcservo_Init(USEDPINS) == false)  // set PWM/GPIO  as Servo mode
  37.     {
  38.         printf("ERROR: fail to init RC Servo lib (%s)!\n", roboio_GetErrMsg());
  39.         return -1;
  40.     }
  41.     return 0;
  42. }

  44. void BodyServoDrive(int channel, long period, long duty)
  45. {
  46.     rcservo_EnterPWMMode();  // make all servo-mode pins go into PWM mode
  47.     printf("Send PWM pulses of period %ldus duty %ldus on pin %d...\n",period,duty,channel+1);
  48.     rcservo_SendCPWM(channel, period, duty);
  49.     printf("Press ENTER to stop.\n"); getchar();
  50.     rcservo_StopPWM(channel);
  51. }

  53.   
複製代碼
試過基本上是沒問題
有問題在提出來吧^^~
回復 支持 反對

舉報

roboardgod
發表於 2012-1-13 12:21:27 | 顯示全部樓層
哇  魔人駕到..... 請受小弟一拜
lucrece_lu 發表於 2012-1-13 09:36



   不不不~ lu大駕到.....  請受小魔一拜
回復 支持 反對

舉報

miaoichi
 樓主| 發表於 2012-1-13 22:31:59 | 顯示全部樓層
回復 12# mzw2008


   我是RB-100，所以我要分開供電?(主板一個電源，全部馬達一個電源，接地共接這樣嗎?)
如果是，我想應該是這個問題。那我再修改一下電路再來試試。

謝謝
回復 支持 反對

舉報

miaoichi
 樓主| 發表於 2012-1-13 22:33:11 | 顯示全部樓層
程式有些小問題

M大的code




魔人修過的code
試過基本上是沒問題
有問題在提出來吧^^~
roboardgod 發表於 2012-1-13 10:43


感謝魔人大的指正，小的馬上再來試試。等結果上po上來吧
謝謝
回復 支持 反對

舉報

mzw2008
發表於 2012-1-13 23:47:50 | 顯示全部樓層
回復  mzw2008
   我是RB-100，所以我要分開供電?(主板一個電源，全部馬達一個電源，接地共接這樣嗎? ...
miaoichi 發表於 2012-1-13 22:31

因為我之前常有這種問題
而且因為接多種不同電壓的馬達
這樣做也可以徹底搞定
畢竟RB-100 要驅動馬達太容易了
理論上應該是隨便作都會動啊
回復 支持 反對

舉報

下一頁 »
12下一頁
返回列表 發新帖
高級模式
B Color Image Link Quote Code Smilies
您需要登錄後才可以回帖 登錄 | 申請會員

本版積分規則

小黑屋|手機版|Archiver|機器人論壇 from 2005.07

GMT+8, 2022-8-20 11:26 , Processed in 0.244624 second(s), 7 queries , Apc On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回復 返回頂部 返回列表