Download presentation
Presentation is loading. Please wait.
Published byRandolf Shepherd Modified over 9 years ago
1
Tightly coupled INS/GPS system using particle filter D0928- system architecture and math functions Part A - Final presentation Students: Royzman Danny Peleg Nati Supervisor: Fiksman Evgeni
2
Math functions ▫Overview ▫Trigonometric ▫Exp{-x} ▫SQRT ▫Implementation ▫Performance Infrastructure – Phase1 ▫Main difficulties ▫Block diagram ▫Controllers diagram Gantt Chart Agenda
3
Math functions - Overview sine & Cosine exp sqrt Particle propagation Revaluation GPS update + Neff Dk computation Reweight
4
Math functions - guidelines The following guidelines were defined for function implementation: I/O format : signed fixed point. Maximum flexibility. Low FPGA resource usage. Reasonable accuracy.
5
Math functions – Overview Initial proposal Initially proposed implementation based on CORDIC algorithm Iterative algorithm. I/O format : variable width signed fixed point. Low HW requirements. Easily adjustable and easily implementable. Allows a generic unified core, for all the functions needed. Rough accuracy estimation is one bit for each iteration.
6
Math functions – Overview CORDIC R&D FunctionIssues Trigonometric Pre and post processing units needed to cover ±Π Exponential Very large convergence zone needed, impractical for CORDIC use Square rootVery large IO format needed, impractical for CORDIC use See project book for more details
7
Math functions – Overview Algorithm adjustments FunctionAlgorithm Trigonometric CORDIC algorithm Exponential“Invariants” method Square root“A non-restoring square root “ algorithm
8
Math functions – Implementation Trigonometric functions Variable-width variable-pipeline CORDIC algorithm. ▫ Sine, Cosine functions implemented in single unit. ▫ Pre & Post processing units added for broader input coverage. ▫ Pipe core contains datapath and control stages. ▫ Pipe core combined from variable (2,4..16) amount of single stages, separated by a register. ▫ Default values: (HW cost/accuracy trade off). Stages total amount : 32 units. Input/output width :32 bit. IO format 1.2.29 input, 1.0.31 output
9
Math functions – Implementation Trigonometric functions Pre-Processing unit Pipe Core Post-Processing unit Default values LUT Input Sine Cosine
10
Math functions – Implementation Trigonometric functions Single pipe stage http://en.wikibooks.org/wiki/Digital_Circuits/CORDIC
11
Math functions – Implementation Trigonometric functions Pre processing unit
12
Math functions – Implementation Trigonometric functions Post processing unit
13
Math functions – Implementation Exponential function “Invariants” method will be used ▫ 17 single stages. ▫ Executing a 4-stages pipe flow. ▫ 5 unique “integer” stages. ▫ 6 unique “fractal” stages, repeated twice for better coverage. ▫ Pipe core contains datapath and control stages. ▫ IO format 0.5.27 input, 0.0.32 output.
14
Math functions – Implementation Exponential function Single stage
15
Math functions – Implementation Square root function “A non-restoring square root” algorithm will be used ▫ Fully combinatorial implementation ▫ 48 unique iterations, can be pipelined. ▫ IO format 0.32.64 input, 0.16.32 output.
16
Math functions – Implementation Square root function Schematic
17
Math functions – Performance PerformanceResource usage Pipe size Clock(MHz) Mean accuracy(%) Comb.ALUDedicated logic registers Trig block 2÷1625.85÷159.64 0.000006 4148÷3585196÷1381 Exp block467.050.311706167 SQRT block07.070.0033932144
18
Infrastructure Infrastructure mile stone - GPS Phase I is done Infrastructure – Phase1 ▫Main difficulties ▫Block diagram ▫Controllers diagram
19
Infrastructure Main difficulties Integration problems between frames. Hardware adjustments for debug. Long compilation time.
20
Infrastructure Phase1 - block diagram Taken from Gadi&Eran’s D1418_BOOK
21
Infrastructure Phase1 - connectivity
24
Infrastructure Phase1 - controllers diagram Main controller1 F.S.M
25
Infrastructure Phase1 - controllers diagram Local controller2 F.S.M
26
Infrastructure Phase1 - controllers diagram Main controller3 F.S.M
27
Infrastructure Phase1 - controllers diagram Main controller4 F.S.M
28
Infrastructure Phase1 - From Debug
29
Infrastructure Phase1 - From Debug +100 cycles
30
Infrastructure Gantt Chart ינוארדצמברנובמבר 23169226191252821 Phase4 Phase3 Phase2
31
Q&A
32
Backup
33
אלגוריתם CORDIC סיבוב וקטור – התמרה כללית :
34
אלגוריתם CORDIC
35
הצובר הזוויתי:
36
אלגוריתם CORDIC שני מצבי עבודה : Rotation by Volder.1– מצב סיבוב 2.Vectoring – מצב וקטורי
37
אלגוריתם CORDIC בסה"כ עבור מצב סיבוב :
38
אלגוריתם CORDIC
40
Regular single stagesAdditional single stages Proposed HW implementation Hyperbolic functions Pre Process Unit Mathematical actions required, compared to regular single stage X. Hu, R. Huber, S. Bass, “Expanding the Range of Convergence of the CORDIC Algorithm”, IEEE Transactions on Computers. Vol. 40, Nº 1, pp. 13-21, Jan.1991. Daniel R. Llamocca-Obregón,Carla P. Agurto-Ríos; A FIXED-POINT IMPLEMENTATION OF THE EXPANDED HYPERBOLIC CORDIC ALGORITHM http://www.iberchip.org/iberchip2006/ponencias/106.pdf Back
41
Proposed HW implementation Hyperbolic functions Pre Process Unit C simulation results, acquired by running D0228 (Neta & Moti) project code. Maximum Exponential input : 375.704604 Minimum Exponential input : 0.12665 Average Exponential input : 14.15504 Convergence zone expansion: Total values checked : >1000000 (One million) Back Values coveredNegative stages 1%0(default) 63%5 87%10
Similar presentations
© 2025 SlidePlayer.com. Inc.
All rights reserved.