久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3705|回復: 0
打印 上一主題 下一主題
收起左側

Arduino程序 16路模塊PWM舵機驅動板控制器 機器人 IIC接口

[復制鏈接]
跳轉到指定樓層
樓主

  1. #include <Adafruit_PWMServoDriver.h>
  2. #include <Wire.h>
  3. #if defined(__AVR__)
  4. #define WIRE Wire
  5. #elif defined(CORE_TEENSY) // Teensy boards
  6. #define WIRE Wire
  7. #else // Arduino Due
  8. #define WIRE Wire1
  9. #endif

  11. // Set to true to print some debug messages, or false to disable them.
  12. #define ENABLE_DEBUG_OUTPUT true

  14. Adafruit_PWMServoDriver::Adafruit_PWMServoDriver(uint8_t addr) {
  15.   _i2caddr = addr;
  16. }

  18. void Adafruit_PWMServoDriver::begin(void) {
  19. WIRE.begin();
  20. reset();
  21. }


  24. void Adafruit_PWMServoDriver::reset(void) {
  25. write8(PCA9685_MODE1, 0x0);
  26. }

  28. void Adafruit_PWMServoDriver::setPWMFreq(float freq) {
  29.   //Serial.print("Attempting to set freq ");
  30.   //Serial.println(freq);
  31.   freq *= 0.9;  // Correct for overshoot in the frequency setting (see issue #11).
  32.   float prescaleval = 25000000;
  33.   prescaleval /= 4096;
  34.   prescaleval /= freq;
  35.   prescaleval -= 1;
  36.   if (ENABLE_DEBUG_OUTPUT) {
  37.     Serial.print("Estimated pre-scale: "); Serial.println(prescaleval);
  38.   }
  39.   uint8_t prescale = floor(prescaleval + 0.5);
  40.   if (ENABLE_DEBUG_OUTPUT) {
  41.     Serial.print("Final pre-scale: "); Serial.println(prescale);
  42.   }
  43.   
  44.   uint8_t oldmode = read8(PCA9685_MODE1);
  45.   uint8_t newmode = (oldmode&0x7F) | 0x10; // sleep
  46.   write8(PCA9685_MODE1, newmode); // go to sleep
  47.   write8(PCA9685_PRESCALE, prescale); // set the prescaler
  48.   write8(PCA9685_MODE1, oldmode);
  49.   delay(5);
  50.   write8(PCA9685_MODE1, oldmode | 0xa1);  //  This sets the MODE1 register to turn on auto increment.
  51.                                           // This is why the beginTransmission below was not working.
  52.   //  Serial.print("Mode now 0x"); Serial.println(read8(PCA9685_MODE1), HEX);
  53. }

  55. void Adafruit_PWMServoDriver::setPWM(uint8_t num, uint16_t on, uint16_t off) {
  56.   //Serial.print("Setting PWM "); Serial.print(num); Serial.print(": "); Serial.print(on); Serial.print("->"); Serial.println(off);

  58.   WIRE.beginTransmission(_i2caddr);
  59.   WIRE.write(LED0_ON_L+4*num);
  60.   WIRE.write(on);
  61.   WIRE.write(on>>8);
  62.   WIRE.write(off);
  63.   WIRE.write(off>>8);
  64.   WIRE.endTransmission();
  65. }

  67. // Sets pin without having to deal with on/off tick placement and properly handles
  68. // a zero value as completely off.  Optional invert parameter supports inverting
  69. // the pulse for sinking to ground.  Val should be a value from 0 to 4095 inclusive.
  70. void Adafruit_PWMServoDriver::setPin(uint8_t num, uint16_t val, bool invert)
  71. {
  72.   // Clamp value between 0 and 4095 inclusive.
  73.   val = min(val, 4095);
  74.   if (invert) {
  75.     if (val == 0) {
  76.       // Special value for signal fully on.
  77.       setPWM(num, 4096, 0);
  78.     }
  79.     else if (val == 4095) {
  80.       // Special value for signal fully off.
  81.       setPWM(num, 0, 4096);
  82.     }
  83.     else {
  84.       setPWM(num, 0, 4095-val);
  85.     }
  86.   }
  87.   else {
  88.     if (val == 4095) {
  89.       // Special value for signal fully on.
  90.       setPWM(num, 4096, 0);
  91.     }
  92.     else if (val == 0) {
  93.       // Special value for signal fully off.
  94.       setPWM(num, 0, 4096);
  95.     }
  96.     else {
  97.       setPWM(num, 0, val);
  98.     }
  99.   }
  100. }

  102. uint8_t Adafruit_PWMServoDriver::read8(uint8_t addr) {
  103.   WIRE.beginTransmission(_i2caddr);
  104.   WIRE.write(addr);
  105.   WIRE.endTransmission();

  107.   WIRE.requestFrom((uint8_t)_i2caddr, (uint8_t)1);
  108.   return WIRE.read();
  109. }

  111. void Adafruit_PWMServoDriver::write8(uint8_t addr, uint8_t d) {
  112.   WIRE.beginTransmission(_i2caddr);
  113.   WIRE.write(addr);
  114.   WIRE.write(d);
  115.   WIRE.endTransmission();
  116. }
復制代碼


16路模塊 PWM舵機驅動板 控制器 機器人 IIC接口 .zip

1.82 MB, 下載次數: 19, 下載積分: 黑幣 -5

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏3 分享淘帖 頂頂 踩踩
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規則

手機版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術交流QQ群281945664

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 久久国产精品视频 | 欧美乱码精品一区二区三区 | 亚洲一区二区高清 | 97色在线观看免费视频 | 久久久久国产精品一区 | 91av视频在线免费观看 | 国产激情第一页 | 九九国产在线观看 | 91免费入口| 亚洲精品日韩精品 | 超碰人人插 | 97碰碰碰 | 羞羞午夜| 狠狠躁夜夜躁人人爽天天高潮 | 九热在线| 亚洲男人天堂av | 欧美一级免费黄色片 | 狠狠狠| 97超碰站 | 国产传媒| 亚洲热在线视频 | 观看av| 一级做a爰片性色毛片16 | 福利视频网站 | 久久久久国产成人精品亚洲午夜 | 日韩精品1区2区 | 国产精品视频一区二区三区 | 欧美精品一区二区三区在线播放 | 国产一区 | 日本久久精品 | 亚洲精品乱码 | 91在线电影 | 欧美成视频在线观看 | 日本成人一区二区 | 中文二区 | 亚州一区二区三区 | 日韩精品成人免费观看视频 | 中文字幕av在线播放 | 欧美一区二区三区在线观看 | 色资源在线观看 | 国产精品一区二 |