Skip to content

Commit

Permalink
fixed-point miniIMU fuse algorithm finished
Browse files Browse the repository at this point in the history
  • Loading branch information
@suhetao
suhetao committed Feb 20, 2015
1 parent cf6edf5 commit b6d7b79
Show file tree
Hide file tree
Showing 2 changed files with 11 additions and 56 deletions.
65 changes: 10 additions & 55 deletions Project/stm32f4_dmp.uvopt
View file
Original file line number Diff line number Diff line change
Expand Up @@ -145,7 +145,7 @@
<Type>0</Type>
<LineNumber>257</LineNumber>
<EnabledFlag>1</EnabledFlag>
<Address>134223130</Address>
<Address>134223414</Address>
<ByteObject>0</ByteObject>
<HtxType>0</HtxType>
<ManyObjects>0</ManyObjects>
Expand All @@ -154,59 +154,14 @@
<BreakIfRCount>1</BreakIfRCount>
<Filename>..\miniIMU\FP\FP_Matrix.h</Filename>
<ExecCommand></ExecCommand>
<Expression></Expression>
<Expression>\\stm32f4_dmp\../miniIMU/FP/FP_Matrix.h\257</Expression>
</Bp>
</Breakpoint>
<WatchWindow1>
<Ww>
<count>0</count>
<WinNumber>1</WinNumber>
<ItemText>RA</ItemText>
</Ww>
<Ww>
<count>1</count>
<WinNumber>1</WinNumber>
<ItemText>HA</ItemText>
</Ww>
<Ww>
<count>2</count>
<WinNumber>1</WinNumber>
<ItemText>KA</ItemText>
</Ww>
<Ww>
<count>3</count>
<WinNumber>1</WinNumber>
<ItemText>X</ItemText>
</Ww>
<Ww>
<count>4</count>
<WinNumber>1</WinNumber>
<ItemText>KY</ItemText>
</Ww>
<Ww>
<count>5</count>
<WinNumber>1</WinNumber>
<ItemText>P</ItemText>
</Ww>
<Ww>
<count>6</count>
<WinNumber>1</WinNumber>
<ItemText>SI</ItemText>
</Ww>
<Ww>
<count>7</count>
<WinNumber>1</WinNumber>
<ItemText>SA</ItemText>
</Ww>
<Ww>
<count>8</count>
<WinNumber>1</WinNumber>
<ItemText>DMA_TxBuffer</ItemText>
</Ww>
<Ww>
<count>9</count>
<WinNumber>1</WinNumber>
<ItemText>out</ItemText>
<ItemText>fRPY</ItemText>
</Ww>
</WatchWindow1>
<WatchWindow2>
Expand Down Expand Up @@ -320,10 +275,10 @@
<FileType>1</FileType>
<tvExp>0</tvExp>
<Focus>0</Focus>
<ColumnNumber>0</ColumnNumber>
<ColumnNumber>20</ColumnNumber>
<tvExpOptDlg>0</tvExpOptDlg>
<TopLine>238</TopLine>
<CurrentLine>272</CurrentLine>
<TopLine>237</TopLine>
<CurrentLine>266</CurrentLine>
<bDave2>0</bDave2>
<PathWithFileName>..\Application\Src\main.c</PathWithFileName>
<FilenameWithoutPath>main.c</FilenameWithoutPath>
Expand Down Expand Up @@ -578,7 +533,7 @@
<Focus>0</Focus>
<ColumnNumber>0</ColumnNumber>
<tvExpOptDlg>0</tvExpOptDlg>
<TopLine>179</TopLine>
<TopLine>173</TopLine>
<CurrentLine>184</CurrentLine>
<bDave2>0</bDave2>
<PathWithFileName>..\Libraries\CMSIS\Device\ST\STM32F4xx\Source\Templates\arm\startup_stm32f40_41xxx.s</PathWithFileName>
Expand Down Expand Up @@ -704,10 +659,10 @@
<FileType>1</FileType>
<tvExp>0</tvExp>
<Focus>0</Focus>
<ColumnNumber>2</ColumnNumber>
<ColumnNumber>27</ColumnNumber>
<tvExpOptDlg>0</tvExpOptDlg>
<TopLine>1</TopLine>
<CurrentLine>1</CurrentLine>
<TopLine>344</TopLine>
<CurrentLine>415</CurrentLine>
<bDave2>0</bDave2>
<PathWithFileName>..\miniIMU\FP\FP_miniIMU.c</PathWithFileName>
<FilenameWithoutPath>FP_miniIMU.c</FilenameWithoutPath>
Expand Down
2 changes: 1 addition & 1 deletion miniIMU/FP/FP_Math.h
View file
Original file line number Diff line number Diff line change
Expand Up @@ -428,7 +428,7 @@ __inline float FastSqrt(float x)
//////////////////////////////////////////////////////////////////////////
//translate from google's skia fixed-point dsp Library.
//
#define TO_FLOAT_DEGREE(x) ((x) * 0.000874264215087890625f)
#define TO_FLOAT_DEGREE(x) ((float)(x) * 0.000874264215087890625f)

#define Q16_TWOPI 411775
#define Q16_PI 205887
Expand Down

0 comments on commit b6d7b79

Please sign in to comment.