STM32兩輪自平衡小車資料

ID:95059 · 發表于 2017-3-18 11:47

stm32單片機做的兩輪自平衡小車資料，帶完整的源碼。還附帶很多pdf教程如pid控制和濾波的資料.

全部資料打包下載：

兩輪自平衡小車資料.rar (8.27 MB, 下載次數: 195)

主程序預覽：

#include "sys.h"
#include "usart.h"
//#include "delay.h"
// 編碼器：100線；電機減速比：150
#include "ofme_led.h"
#include "ofme_filter.h"
#include "ofme_iic.h"
#include "ofme_iic_dev.h"
#include "ofme_pwm.h"
#include "ofme_pid.h"
#include "ofme_encoder.h"
#include "ofme_io.h"
#include "ofme_time.h"
#include "ofme_ir_nec.h"
#define PI (3.14159265)
// 度數表示的角速度*1000
#define MDPS (70)
// 弧度表示的角速度
#define RADPS ((float)MDPS*PI/180000)
// 每個查詢周期改變的角度
#define RADPT (RADPS/(-100))
// 平衡的角度范圍；+-60度(由于角度計算采用一階展開，實際值約為46度)
#define ANGLE_RANGE_MAX (60*PI/180)
#define ANGLE_RANGE_MIN (-60*PI/180)
// 全局變量
pid_s sPID; // PID控制參數結構體
float radian_filted=0; // 濾波后的弧度
accelerometer_s acc; // 加速度結構體，包含3維變量
gyroscope_s gyr; // 角速度結構體，包含3維變量
int speed=0, distance=0; // 小車移動的速度，距離
int tick_flag = 0; // 定時中斷標志
int pwm_speed = 0; // 電機pwm控制的偏置值，兩個電機的大小、正負相同，使小車以一定的速度前進
int pwm_turn = 0; // 電機pwm控制的差異值，兩個電機的大小相同，正負相反，使小車左、右轉向
float angle_balance = 0; // 小車的平衡角度。由于小車重心的偏移，小車的平衡角度不一定是radian_filted為零的時候
// 定時器周期中斷，10ms
void sys_tick_proc(void)
{
static unsigned int i = 0;
tick_flag++;
i++;
if(i>=100) i=0;
if(i==0) // 綠燈的閃爍周期為1秒
{
LED1_OFF();
}
else if(i==50)
{
LED1_ON();
}
}
void control_proc(void)
{
int i = ir_key_proc(); // 將紅外接收到的按鍵值，轉換為小車控制的相應按鍵值。
switch(i)
{
case KEY_TURN_LEFT:
if(pwm_turn<500) pwm_turn += 50;
break;
case KEY_TURN_RIGHT:
if(pwm_turn>-500) pwm_turn -= 50;
break;
case KEY_TURN_STOP:
pwm_turn = 0;
distance = 0;
pwm_speed = 0;
break;
case KEY_SPEED_UP:
if(pwm_speed<500) pwm_speed+=100;
break;
case KEY_SPEED_DOWN:
if(pwm_speed>-500) pwm_speed-=100;
break;
case KEY_SPEED_0:
pwm_speed = 0;
break;
case KEY_SPEED_F1:
pwm_speed = 150;
break;
case KEY_SPEED_F2:
pwm_speed = 300;
break;
case KEY_SPEED_F3:
pwm_speed = 450;
break;
case KEY_SPEED_F4:
pwm_speed = 600;
break;
case KEY_SPEED_F5:
pwm_speed = 750;
break;
case KEY_SPEED_F6:
pwm_speed = 900;
break;
case KEY_SPEED_B1:
pwm_speed = -150;
case KEY_SPEED_B2:
pwm_speed = -300;
case KEY_SPEED_B3:
pwm_speed = -450;
break;
default:
break;
}
pwm_turn *= 0.9; // pwm_turn的值以0.9的比例衰減，使小車在接收到一個轉向信號后只轉動一定的時間后停止轉動。
speed = speed*0.7 +0.3*(encoder_read()); // 定周期（10ms）讀取編碼器數值得到實時速度，再對速度進行平滑濾波
if(speed!=0)
{
printf("speed: %d, dst: %d, pwm: %d \r\n", speed,distance,(int)(speed*6+distance*0.1));
}
encoder_write(0); // 編碼器值重新設為0
distance += speed; // 對速度進行積分，得到移動距離
if(distance>6000) distance = 6000; // 減少小車懸空、空轉對控制的影響
else if(distance<-6000) distance = -6000;
}
void balance_proc(void)
{
static unsigned int err_cnt=0;
// float tFloat;
int pwm_balance;
// static float angle;
// float angle_t;
float radian, radian_pt; // 當前弧度及弧度的微分(角速度，角度值用弧度表示）
adxl345_read(&acc); // 讀取當前加速度。由于傳感器按照的位置原因，傳感器的值在函數內部經過處理，變為小車的虛擬坐標系。
l3g4200d_read(&gyr); // 讀取當前角速度。同樣經過坐標系變換。
// 此段程序用于傳感器出錯時停止小車
err_cnt = err_cnt*115>>7; // err_cnt以0.9的比例系數衰減(115>>7的值約為0.9，避免浮點數，提高速度)
if(acc.flag != 0x0F || gyr.flag != 0x0F) // 讀取的角度、角速度值有誤�？赡苁请姶鸥蓴_、iic線太長等導致出錯。
{
LED0_ON(); // 亮紅燈
err_cnt +=100; // 等比數列，比例系數0.9(115>>7)，常數項100；根據公式，連續10項的和約為657
if(err_cnt>657) goto err; // 當連續發生約10次（約0.1秒）錯誤則超過657而溢出。
}
// 此段程序用于倒立或失重時停止小車
if(acc.z<=0)
{
goto err;
}
// 小車的虛擬x軸方向為小車前進方向，虛擬y軸為小車左邊，虛擬z軸為小車上升方向。
// 前傾角度為負，后傾角度為正。
// 通過計算加速度分量，得到小車傾斜弧度（未濾波）
radian = (float)(acc.x)/acc.z; // 一階展開：Q =f(x)=x-x^3/3+x^5/5+...+(-1)^k*x^(2k+1)/(2k+1)+...
// 通過角速度傳感器，得到小車的角速度（單位為弧度/秒）
radian_pt = gyr.y*RADPT;
radian_filted = ofme_filter(radian_filted, radian, radian_pt); // 互補濾波得到小車的傾斜角度
// 此段程序用于小車傾斜角度過大時，停止小車
if(radian_filted> ANGLE_RANGE_MAX || radian_filted<ANGLE_RANGE_MIN)
{
goto err;
}
// 通過PID計算，得到保持小車角度為零所需要的電機pwm輸出
pwm_balance = pid_proc(&sPID, radian_filted, radian_pt);
// printf("%d\r\n",speed);
// 通過小車移動速度與移動距離，調整小車平衡所需的pwm輸出
pwm_balance += (speed*6+distance*0.1);
// 在pwm_balance的基礎上，加上速度分量與轉動分量，調整小車兩個電機的轉速。
pwm_control(pwm_balance+pwm_speed+pwm_turn, pwm_balance+pwm_speed-pwm_turn);
// 如果pwm超出有效值，紅燈亮。用于調試，了解系統狀態。
if(pwm_balance>=1000||pwm_balance<=-1000) LED1_ON();
LED0_OFF();
return;
err:
puts("balance error.\r\n");
pwm_control(0, 0); // 關閉電機
return;
}
int main(void)
{
// int i=0, t;
// int pwm;
// float radian, radian_pt;
Stm32_Clock_Init(9);//系統時鐘設置
uart_init(72,57600); //串口1初始化
hw_tick_start(); // 定時器周期性中斷，用于提供系統脈搏
////////////////////////////////////////////////////////////////////////////////
led_init();
pwm_init();
iic_init();
adxl345_init(&acc);
l3g4200d_init(&gyr);
hw_ir_init();
encoder_init();
while(0)
{
if(tick_flag>100)
{
tick_flag = 0;
printf("count: %d\r\n",encoder_read());
}
}
////////////////////////////////////////////////////////////////////////////////
// pid_init(&sPID, 4500,0,-300);6000--350 ;8000--350;11000--350;
// pid_init(&sPID, 6000,0,-35000);
pid_init(&sPID, 7500,0,-35000); // 調節PID參數，后3個形參分別為：比例系數P，積分系數I，微分系數D
sPID.target = -3.5*PI/180;
radian_filted = 0;
adxl345_init(&acc);
l3g4200d_init(&gyr);
while(1)
{
if(tick_flag)
{
tick_flag = 0;
balance_proc(); // 調節小車，保持平衡
control_proc(); // 根據遙控接收到的數據，調整電機輸出參數
}
}
}

復制代碼

ID:1 · 發表于 2017-3-18 21:26

iic部分源碼：

#include "ofme_iic.h"
////////////////////////////////////////////////////////////////////////////////
// ofme_iic.c
// v2012.12.20
// Copyright(C) ofourme@163.com
// All rights reserved
////////////////////////////////////////////////////////////////////////////////
// iic 主機模擬程序 for F/S mode
// 不可重入
// 所有的函數結束后都是占有scl總線的，故不會有別的主機與之競爭（除非與別的主...
// 機處于完全同步），但別的主機也可能在程序運行期間加入競爭。
////////////////////////////////////////////////////////////////////////////////
// 詳見《I2C總線規范（周立功翻譯版）》
// 傳輸格式：P8~P10
// 同步與仲裁：P10~P11
// 時序要求：P27~P28
// tag: 同步發生于主機活躍的所有時間
// 仲裁發生于主機發送數據的情況，包括ACK位
////////////////////////////////////////////////////////////////////////////////
// 全局變量，用于保存IIC_TIME_OUT等錯誤信息。通過iic_error_check()獲取。
static int _IIC_ERROR_CODE = IIC_OK;
////////////////////////////////////////////////////////////////////////////////
#ifndef F_SCL
#err "F_SCL not defined."
#elif (F_SCL==100)
////////////////////////////////////////////////////////////////////////////////
// （重復）起始條件的保持時間。在這個周期后，產生第一個時間脈沖...
// 4.0us<t_hd_sta or 0.6us<t_hd_sta
#define T_HD_STA (4)
// SCL時鐘的低電平周期 4.7us<t or 1.3us<t
// SDA should hold at least 300ns while SCL is falling
#define T_LOW1 (1)
#define T_LOW2 (4)
#define T_LOW (T_LOW1+T_LOW2)
// SCL時鐘的高電平周期 4.0us<t or 0.6us<t
#define T_HIGH (4)
// 重復起始條件的建立時間 4.7us<t or 0.6us<t
#define T_SU_STA (5)
// 數據保持時間：
// IIC總線器件：0<t<3.45us or 0<t<0.9us
// 兼容CUBS的主機：5.0us<t<NULL or NULL<t<NULL
// SDA should hold at least 300ns while SCL is falling
#define T_HD_DAT (1)
// 數據建立時間：250ns<t or 100ns<t
#define T_SU_DAT (1)
// 停止條件的建立時間：4.0us<t or 0.6us<t
#define T_SU_STO (4)
// 停止和啟動條件之間的總線空閑時間 4.7us<t_buf or 1.3us<t_buf
#define T_BUF (5)
////////////////////////////////////////////////////////////////////////////////
#elif (F_SCL==400)
////////////////////////////////////////////////////////////////////////////////
#define T_HD_STA (1)
#define T_LOW1 (1)
#define T_LOW2 (1)
#define T_LOW (T_LOW1+T_LOW2)
#define T_HIGH (1)
#define T_SU_STA (1)
#define T_HD_DAT (0)
#define T_SU_DAT (1)
#define T_SU_STO (1)
#define T_BUF (2)
////////////////////////////////////////////////////////////////////////////////
#else
#err "F_SCL value error."
#endif
////////////////////////////////////////////////////////////////////////////////
// 提供給iic的延時函數，單位為1微秒。
#ifndef iic_delay
#err "iic_delay() not defined."
#endif
////////////////////////////////////////////////////////////////////////////////
// 主機釋放SCL總線，而且等待外部主機、設備釋放SCL總線。用于SCL同步。
/* "IIC SCL SYNCHRONIZE." 不屬于異常錯誤，故大寫表示。*/
#define IIC_SCL_RELEASE(t) \
{\
SCL_H();\
t = 0;\
while(SCL==0)\
{\
t++;\
if(t==IIC_RAISING_COUNT) IIC_DEBUG("IIC SCL SYNCHRONIZE.\r\n");\
if(t>=IIC_TIME_OUT_COUNT)\
{\
_IIC_ERROR_CODE = IIC_TIME_OUT;\
IIC_DEBUG("iic scl synchronize time out.\r\n");\
break;\
}\
}\
}
////////////////////////////////////////////////////////////////////////////////
// 保持時間T的高電平。但是如果總線電平被外部拉低，則提前退出。用于SCL同步。
#define IIC_SCL_HOLD(T, t) \
{\
for(t=0; t<T; t++)\
{\
iic_delay(1);\
if(SCL==0) break;\
}\
}
////////////////////////////////////////////////////////////////////////////////
void iic_init(void)
{
hw_iic_init(); // 外部函數。配置端口為開漏輸出。
// _IIC_ERROR_CODE = IIC_OK; // 延后到iic_start()里面設置。
SCL_H(); // 釋放端口
SDA_H();
}
////////////////////////////////////////////////////////////////////////////////
// iic_start()函數在總線忙碌的情況下返回失敗值
int iic_start(void)
{
// 其它主機可能處于<1>start、<2>restart、<3>stop、<4>讀寫SDA且SDA為高電平。
// 有可能獨占總線或與別的主機同步占有總線，這是我們希望的最好結果。
// 但iic協議是否有可能導致不同步地占有總線？
//
// 程序實際上應該檢查總線在T_BUF期間是否被占用，保證起始標志時序不被打斷，...
// 但使用軟件查詢方式無法確切認定在延時期間總線電平沒有被外部主機拉低，...
// 本程序的缺陷有可能導致不同步地占有總線�。�！
// 只能寄希望于程序在后面的多主機競爭中失敗退出而避免錯誤了。
_IIC_ERROR_CODE = IIC_OK;
SCL_H();
SDA_H();
iic_delay(T_BUF+T_BUF_ALT); // 保證SCL與SDA線的高電平維持時間
if( SCL==0 ) // SCL總線忙
{
return IIC_SCL_BUSY;
}
if( SDA==0 ) // SDA總線忙
{
return IIC_SDA_BUSY;
}
SDA_L();
iic_delay(T_HD_STA);
SCL_L(); // get the SCL & SDA bus
return IIC_OK;
}
////////////////////////////////////////////////////////////////////////////////
// 在傳輸完數據后可立即調用iic_restart()，與iic_start()類似。
void iic_restart(void)
{
int t;
// scl==0
SDA_H();
iic_delay(T_LOW);
IIC_SCL_RELEASE(t);
iic_delay(T_SU_STA);
SDA_L();
iic_delay(T_HD_STA);
SCL_L(); // get the SCL & SDA bus
}
////////////////////////////////////////////////////////////////////////////////
void iic_stop(void)
{
// scl==0
SDA_L();
iic_delay(T_LOW);
SCL_H(); // release SCL, ignore pulling down by other device.
iic_delay(T_SU_STO);
SDA_H(); // release SDA
}
////////////////////////////////////////////////////////////////////////////////
// 主機接收數據發送ack, 比較響應位進行多主機仲裁，由于ack為低電平，故實際不仲裁
void iic_ack(void)
{
int t;
// scl==0
SDA_L(); // ack
iic_delay(T_LOW);
IIC_SCL_RELEASE(t); // SCL SYNCHRONIZE
IIC_SCL_HOLD(T_HIGH, t); // SCL SYNCHRONIZE
SCL_L(); // get the SCL bus
}
////////////////////////////////////////////////////////////////////////////////
// 主機接收數據發送nack, 比較響應位進行多主機仲裁
int iic_nack(void)
{
int t;
// scl==0
SDA_H(); // nack
iic_delay(T_LOW);
IIC_SCL_RELEASE(t); // SCL SYNCHRONIZE
if(SDA==0)
{ // scl & sda had been released before.
IIC_DEBUG("iic_nack() arbitrate failed.\r\n");
// 應該不用再發送時鐘直到nack周期結束？
return IIC_AARB_FAIL;
}
IIC_SCL_HOLD(T_HIGH, t); // SCL SYNCHRONIZE
SCL_L(); // get the SCL bus
return IIC_OK;
}
////////////////////////////////////////////////////////////////////////////////
// 主機發送數據完等待從機響應ack or nack，不進行多主機仲裁
int iic_wait_ack(void)
{
int t, data;
// scl==0
SDA_H(); // release SDA
iic_delay(T_LOW); // wait for SDA to be change
IIC_SCL_RELEASE(t); // SCL SYNCHRONIZE
data = SDA;
IIC_SCL_HOLD(T_HIGH, t); // SCL SYNCHRONIZE
SCL_L(); // get the SCL bus
if(data) return IIC_NACK;
else return IIC_ACK;
}
////////////////////////////////////////////////////////////////////////////////
// 主機讀取數據，不比較數據位進行多主機仲裁
u8 iic_read(void)
{
u8 d;
int i, t;
// sda==0, scl==0;
SDA_H(); // release SDA, wait for SDA to be change
for(i=0, d=0; i<8; i++)
{
iic_delay(T_LOW);
IIC_SCL_RELEASE(t); // SCL SYNCHRONIZE
// read_bit();
d<<=1;
if(SDA) d++;
// 理論上read函數和write函數在這里收發字節的第1位時，應不斷檢測SCL高電平期間，...
// SDA的電平有無變化以識別restart()或stop()標志，但同時還要檢測SCL有無被外部拉低...
// 在不使用中斷而采用純粹查詢手段的情況下，實現起來有困難，故不做判斷。
IIC_SCL_HOLD(T_HIGH, t); // SCL SYNCHRONIZE
SCL_L(); // get the SCL bus
}
return d;
}
////////////////////////////////////////////////////////////////////////////////
// 主機發送數據，比較數據位進行多主機仲裁
// 主機在發送數據的第一位且第一位為1時，其它主機可能在SCL高電平期間發送...
// restart()或是stop()標志，也即電平0->1或是1->0，理論上程序應該檢測這種...
// 情況的發生，并停止發送數據而發送一樣的restart或是stop標志（見P11）。
// 為簡化程序，一旦遇到這種情況既轉化為IIC_ARB_FAIL處理。
int iic_write(u8 data)
{
int i, t, err = IIC_OK;
// sda==0, scl==0;
for(i=0; i<8; i++, data<<=1)
{
iic_delay(T_LOW1);
// send_bit();
if(data&0x80)
SDA_H();
else
SDA_L();
//
iic_delay(T_LOW2);
IIC_SCL_RELEASE(t); // SCL SYNCHRONIZE
if( data&0x80 && (SDA==0) )//仲裁失敗
{ // scl & sda had been released before.
// 理論上仲裁失敗就由其它主機接管控制器，程序可以停止產生SCL...
// 在這里我們應該可以直接返回 IIC_DARB_FAIL
// return IIC_DARB_FAIL;
// 但我選擇發送0xff直到字節結束
err = IIC_DARB_FAIL;
data = 0xFF;
}
IIC_SCL_HOLD(T_HIGH, t); // SCL SYNCHRONIZE
SCL_L(); // get the SCL bus
}
return err;
}
////////////////////////////////////////////////////////////////////////////////
#if 0
int iic_dev_read(u8 dev, u8 addr, u8* data)
{
// 注意將IIC_DEBUG()放iic_stop()后面，以免影響總線時序。
int i;
i = iic_start(); // select the device and set address
if( i != IIC_OK ) goto err_bus_busy;
i = iic_write(dev);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_dev_fail;
i = iic_write(addr);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_tar_fail;
iic_restart();
i = iic_write(dev|1); // start read
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_dev_fail;
*data = iic_read();
i = iic_nack();// write nack to tell the slave stop transfer data.
if( i != IIC_OK ) goto err_arb_fail;
//end:
iic_stop();
// IIC_DEBUG("R: IIC READ DONE.\r\n");
if(_IIC_ERROR_CODE & IIC_TIME_OUT)
{
IIC_DEBUG("r: iic time out.\r\n");
return _IIC_ERROR_CODE;
}
return IIC_OK;
err_bus_busy:
if(i == IIC_SCL_BUSY)
IIC_DEBUG("r: iic scl bus busy.\r\n");
else
IIC_DEBUG("r: iic sda bus busy.\r\n");
return i | _IIC_ERROR_CODE;
err_arb_fail:
// 總線仲裁失敗可能是由于硬件錯誤或是多主機競爭。如果是硬件錯誤，應繼續產生...
// 時鐘到字節傳輸結束，然后釋放總線？不管怎樣，都不應該再調用iic_stop();
SDA_H();
SCL_H();
IIC_DEBUG("r: iic bus arbitrate failed.\r\n");
return i | _IIC_ERROR_CODE; // IIC_ARB_FAIL
err_dev_fail:
iic_stop();
IIC_DEBUG("r: iic device not respond.\r\n");
return IIC_DEVICE_FAIL | _IIC_ERROR_CODE;
err_tar_fail:
iic_stop();
IIC_DEBUG("r: device target not respond.\r\n");
return IIC_TARGET_FAIL | _IIC_ERROR_CODE;
}
#else
int iic_dev_read(u8 dev, u8 addr, u8* data)
{
return iic_dev_gets(dev, addr, data, 1);
}
#endif
////////////////////////////////////////////////////////////////////////////////
int iic_dev_gets(u8 dev, u8 addr, u8* data, u16 n)
{
int i;
i = iic_start(); // select the device and set address
if( i != IIC_OK ) goto err_bus_busy;
i = iic_write(dev);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_dev_fail;
i = iic_write(addr);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_tar_fail;
iic_restart();
i = iic_write(dev|1); // start read
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_dev_fail;
if(n<1) n=1;
while(--n)
{
*data++ = iic_read();
iic_ack();
}
*data = iic_read();
i = iic_nack();// write nack to tell the slave stop transfer data.
if( i != IIC_OK ) goto err_arb_fail;
//end:
iic_stop();
// IIC_DEBUG("R: IIC READ DONE.\r\n");
if(_IIC_ERROR_CODE & IIC_TIME_OUT)
{
IIC_DEBUG("r: iic time out.\r\n");
return _IIC_ERROR_CODE;
}
return IIC_OK;
err_bus_busy:
if(i == IIC_SCL_BUSY)
IIC_DEBUG("r: iic scl bus busy.\r\n");
else
IIC_DEBUG("r: iic sda bus busy.\r\n");
return i | _IIC_ERROR_CODE;
err_arb_fail:
// 總線仲裁失敗可能是由于硬件錯誤或是多主機競爭。如果是硬件錯誤，應繼續產生...
// 時鐘到字節傳輸結束，然后釋放總線？不管怎樣，都不應該再調用iic_stop();
SDA_H();
SCL_H();
IIC_DEBUG("r: iic bus arbitrate failed.\r\n");
return i | _IIC_ERROR_CODE; // IIC_ARB_FAIL
err_dev_fail:
iic_stop();
IIC_DEBUG("r: iic device not respond.\r\n");
return IIC_DEVICE_FAIL | _IIC_ERROR_CODE;
err_tar_fail:
iic_stop();
IIC_DEBUG("r: device target not respond.\r\n");
return IIC_TARGET_FAIL | _IIC_ERROR_CODE;
}
////////////////////////////////////////////////////////////////////////////////
#if 0
int iic_dev_write(u8 dev, u8 addr, u8 data)
{
// 注意將IIC_DEBUG()放iic_stop()后面，以免影響總線時序。
int i;
i = iic_start();
if( i != IIC_OK ) goto err_bus_busy;
i = iic_write(dev);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_dev_fail;
i = iic_write(addr);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_tar_fail;
i = iic_write(data);
if( i != IIC_OK ) goto err_arb_fail;
// 如果返回IIC_NACK，則不能再繼續往從機寫數據。本函數只寫一字節的數據，故忽略。
i = iic_wait_ack();
//end:
iic_stop();
// IIC_DEBUG("W: IIC WRITE DONE.\r\n");
if( i != IIC_ACK)
IIC_DEBUG("w: IIC DEVICE NO ACK.\r\n");
if(_IIC_ERROR_CODE & IIC_TIME_OUT)
{
IIC_DEBUG("w: iic time out.\r\n");
return _IIC_ERROR_CODE;
}
return IIC_OK;
err_bus_busy:
if(i == IIC_SCL_BUSY)
IIC_DEBUG("w: iic scl bus busy.\r\n");
else
IIC_DEBUG("w: iic sda bus busy.\r\n");
return i | _IIC_ERROR_CODE;
err_arb_fail:
// 總線仲裁失敗可能是由于硬件錯誤或是多主機競爭。如果是硬件錯誤，應繼續產生...
// 時鐘到字節傳輸結束，然后釋放總線？不管怎樣，都不應該再調用iic_stop();
SDA_H();
SCL_H();
IIC_DEBUG("w: iic bus arbitrate failed.\r\n");
return i | _IIC_ERROR_CODE; // IIC_ARB_FAIL
err_dev_fail:
iic_stop();
IIC_DEBUG("w: iic device not respond.\r\n");
return IIC_DEVICE_FAIL | _IIC_ERROR_CODE;
err_tar_fail:
iic_stop();
IIC_DEBUG("w: device target not respond.\r\n");
return IIC_TARGET_FAIL | _IIC_ERROR_CODE;
}
#else
int iic_dev_write(u8 dev, u8 addr, u8 data)
{
u8 buf = data;
return iic_dev_puts(dev, addr, &buf, 1);
}
#endif
////////////////////////////////////////////////////////////////////////////////
int iic_dev_puts(u8 dev, u8 addr, u8* data, u16 n)
{
// 注意將IIC_DEBUG()放iic_stop()后面，以免影響總線時序。
int i;
i = iic_start();
if( i != IIC_OK ) goto err_bus_busy;
i = iic_write(dev);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_dev_fail;
i = iic_write(addr);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_tar_fail;
if(n<1) n=1;
while(--n)
{
i = iic_write(*data++);
if( i != IIC_OK ) goto err_arb_fail;
i = iic_wait_ack();
if( i != IIC_ACK) goto err_tar_fail; //could not write data.
}
i = iic_write(*data);
if( i != IIC_OK ) goto err_arb_fail;
iic_wait_ack(); // 最后一個字節，忽略ack。
//end:
iic_stop();
// IIC_DEBUG("W: IIC WRITE DONE.\r\n");
if(_IIC_ERROR_CODE & IIC_TIME_OUT)
{
IIC_DEBUG("w: iic time out.\r\n");
return _IIC_ERROR_CODE;
}
return IIC_OK;
err_bus_busy:
if(i == IIC_SCL_BUSY)
IIC_DEBUG("w: iic scl bus busy.\r\n");
else
IIC_DEBUG("w: iic sda bus busy.\r\n");
return i | _IIC_ERROR_CODE;
err_arb_fail:
// 總線仲裁失敗可能是由于硬件錯誤或是多主機競爭。如果是硬件錯誤，應繼續產生...
// 時鐘到字節傳輸結束，然后釋放總線？不管怎樣，都不應該再調用iic_stop();
SDA_H();
SCL_H();
IIC_DEBUG("w: iic bus arbitrate failed.\r\n");
return i | _IIC_ERROR_CODE; // IIC_ARB_FAIL
err_dev_fail:
iic_stop();
IIC_DEBUG("w: iic device not respond.\r\n");
return IIC_DEVICE_FAIL | _IIC_ERROR_CODE;
err_tar_fail:
iic_stop();
IIC_DEBUG("w: device target not respond.\r\n");
return IIC_TARGET_FAIL | _IIC_ERROR_CODE;
}
////////////////////////////////////////////////////////////////////////////////

復制代碼

ID:1 · 發表于 2017-3-18 21:26

紅外遙控部分：

#include "ofme_ir_nec.h"
#include "ofme_time.h"
#define NEC_HEAD_PLUSE_MAX (9000+900)
#define NEC_HEAD_PLUSE_MIN (9000-630)
#define NEC_HEAD_SPACE_MAX (4500+450)
#define NEC_HEAD_SPACE_MIN (4500-315)
#define NEC_HEAD_MAX (NEC_HEAD_PLUSE_MAX+NEC_HEAD_SPACE_MAX)
#define NEC_HEAD_MIN (NEC_HEAD_PLUSE_MIN+NEC_HEAD_SPACE_MIN)
#define NEC_DATA_PLUSE_MAX (560+56)
#define NEC_DATA_PLUSE_MIN (560-56)
#define NEC_LOG0_SPACE_MAX (560+56)
#define NEC_LOG0_SPACE_MIN (560-56)
#define NEC_LOG0_MAX (NEC_DATA_PLUSE_MAX+NEC_LOG0_SPACE_MAX)
#define NEC_LOG0_MIN (NEC_DATA_PLUSE_MIN+NEC_LOG0_SPACE_MIN)
#define NEC_LOG1_SPACE_MAX (1680+168)
#define NEC_LOG1_SPACE_MIN (1680-168)
#define NEC_LOG1_MAX (NEC_DATA_PLUSE_MAX+NEC_LOG1_SPACE_MAX)
#define NEC_LOG1_MIN (NEC_DATA_PLUSE_MIN+NEC_LOG1_SPACE_MIN)
#define NEC_REPEAT_PLUSE_MAX (9000+630)
#define NEC_REPEAT_PLUSE_MIN (9000-900)
#define NEC_REPEAT_SPACE_MAX (2500+175)
#define NEC_REPEAT_SPACE_MIN (2500-250)
#define NEC_REPEAT_DELAY_MAX (97940+9794+NEC_DATA_PLUSE_MAX)
#define NEC_REPEAT_DELAY_MIN (97940-9794+NEC_DATA_PLUSE_MIN)
#define NEC_REPEAT_MAX (NEC_REPEAT_PLUSE_MAX+NEC_REPEAT_SPACE_MAX)
#define NEC_REPEAT_MIN (NEC_REPEAT_PLUSE_MIN+NEC_REPEAT_SPACE_MIN)
#define IR_INT_CLR() EXTI->PR = 1<<1
#define IR_NEC_DEBUG
// 接收到的數值
u32 ir_data;
// <0: ir_data無效; 0:ir_data有效，但已經被處理過；>0: 連發次數；當>0，外部程序可以進行-1操作表示讀取數據
int ir_repeat = -1;
// 0: OK; >0: error count; 外部程序可讀取此數值了解有無干擾信號或用于debug
int ir_err_cnt = 0;
void hw_ir_init(void)
{
//初始化紅外接收引腳的設置
//開啟中斷,并映射
RCC->APB2ENR|=1<<4; //PC時鐘使能
GPIOC->CRL&=0XFFFFFF0F;
GPIOC->CRL|=0X00000080; //PC1輸入
GPIOC->ODR|=1<<1; //PC.1上拉
Ex_NVIC_Config(GPIO_C,1,FTIR);//將line1映射到PC.1，下降沿觸發.
MY_NVIC_Init(2,1,EXTI1_IRQChannel,2);
}
// 一體化紅外接收頭只能通過38kHz左右的載波（抗干擾&節能），并轉化為TTL低電平
// 下降沿中斷
void EXTI1_IRQHandler(void)
//void ir_nec_receive(void)
{
// step(<=-1：表示重復幀結束; 0：表示數據幀的開頭；32：表示連續幀之間的間隔；>=33：表示重復幀的開頭)
static int step=-1;
static int time1=0;
int time2;
int interval;
time2 = hw_time_get();
interval = hw_interval_get(time1,time2);
time1 = time2;
if(interval>NEC_REPEAT_DELAY_MAX)//連發碼之間的最大間隔
{
step = -1;
goto err;
}
else if(interval>NEC_HEAD_MAX)
{
goto err;
}
else if(interval>NEC_HEAD_MIN)
{
ir_repeat=-1; // 表示ir_data無效
ir_data = 0;
step = 0;
#ifdef IR_NEC_DEBUG
putchar('[');
#endif
IR_INT_CLR();
return;
}
else if(interval>NEC_REPEAT_MAX)
{
goto err;
}
else if(interval>NEC_REPEAT_MIN)
{
if(step != 33) goto err;
step = 32;
ir_repeat++;
#ifdef IR_NEC_DEBUG
putchar('-');
putchar('R');
printf("-%d*%d.", (ir_data>>16)&0x0FF, ir_repeat);
#endif
IR_INT_CLR();
return;
}
else if(interval>NEC_LOG1_MAX)
{
goto err;
}
else if(interval>NEC_LOG1_MIN)
{
goto decode;
}
else if(interval>NEC_LOG0_MAX)
{
goto err;
}
else if(interval>NEC_LOG0_MIN)
{
goto decode;
}
else
{
goto err;
}
// 只有長度為0或1的脈沖才能執行到這里
decode:
if(step<0 || step>=32) goto err;
ir_data>>= 1;
if(interval>NEC_LOG1_MIN)
{
ir_data |= 0x80000000UL;
}
step++;
if(step==32)
{
ir_repeat = 1;
#ifdef IR_NEC_DEBUG
putchar(']');
printf("-%d*%d.", (ir_data>>16)&0x0FF, ir_repeat);
#endif
}
IR_INT_CLR();
return;
err:
#ifdef IR_NEC_DEBUG
putchar('\r');
putchar('\n');
#endif
if(step == 32)
{
step = 33;
#ifdef IR_NEC_DEBUG
putchar('R');
#endif
}
else if(step>=0) // 數據接收出錯
{
ir_err_cnt++;
step = -1;
#ifdef IR_NEC_DEBUG
putchar('E');
#endif
}
else
{
#ifdef IR_NEC_DEBUG
putchar('S');
#endif
}
IR_INT_CLR();
return;
}

復制代碼

ID:146110 · 發表于 2017-4-30 17:03

兩輪的人玩的不多呀

ID:95059 · 發表于 2017-8-13 21:22

tam1974 發表于 2017-4-30 17:03
兩輪的人玩的不多呀

難度比較大，所以玩得人少

ID:134810 · 發表于 2017-9-27 15:54

是這樣的

ID:313772 · 發表于 2018-4-22 15:46

適合初學者做嘛

ID:363726 · 發表于 2018-7-18 08:31

學習

ID:243161 · 發表于 2018-8-4 14:26

感謝分享

ID:87766 · 發表于 2018-9-7 11:02

謝謝分享

帳號		自動登錄	找回密碼
密碼			立即注冊

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

STM32兩輪自平衡小車資料

相關帖子