KALMAN FILTERING
KALMAN FILTERING
Theory and Practice Using MATLAB
w
Third Edition
MOHINDER S. GREWAL
California State University at Fullerton
ANGUS P. ANDREWS
Rockwell Science Center (retired)
Copyright # 2008 by John Wiley & Sons, Inc. All rights reserved
Published by John Wiley & Sons, Inc., Hoboken, New Jersey
Published simultaneously in Canada
No part of this publication may be reproduced, stored in a retrieval system, or transmitted in any form or by
any means, electronic, mechanical, photocopying, recording, scanning, or otherwise, except as permitted
under Section 107 or 108 of the 1976 United States Copyright Act, without either the prior written
permission of the Publisher, or authorization through payment of the appropriate per-copy fee to the
Copyright Clearance Center, Inc., 222 Rosewood Drive, Danvers, MA 01923, (978) 750-8400, fax
(978) 750-4470, or on the web at www.copyright.com. Requests to the Publisher for permission should
be addressed to the Permissions Department, John Wiley & Sons, Inc., 111 River Street, Hoboken, NJ
07030, (201) 748-6011, fax (201) 748-6008, or online at http:// www.wiley.com/go/permission.
Limit of Liability/Disclaimer of Warranty: While the publisher and author have used their best efforts in
preparing this book, they make no representations or warranties with respect to the accuracy or complete-
ness of the contents of this book and specifically disclaim any implied warranties of merchantability or
fitness for a particular purpose. No warranty may be created or extended by sales representatives or
written sales materials. The advice and strategies contained herein may not be suitable for your situation.
You should consult with a professional where appropriate. Neither the publisher nor author shall be liable
for any loss of profit or any other commercial damages, including but not limited to special, incidental,
consequential, or other damages.
For general information on our other products and services or for technical support, please contact our
Customer Care Department within the United States at (800) 762-2974, outside the United States at
(317) 572-3993 or fax (317) 572-4002.
Wiley also publishes its books in a variety of electronic formats. Some content that appears in print may
not be available in electronic format. For more information about Wiley products, visit our web site at
www.wiley.com.
Library of Congress Cataloging-in-Publication Data:
Grewal, Mohinder S.
Kalman filtering : theory and practice using MATLAB/Mohinder S. Grewal,
Angus P. Andrews. — 3rd ed.
p. cm.
Includes bibliographical references and index.
ISBN 978-0-470-17366-4 (cloth)
1. Kalman filtering. 2. MATLAB. I. Andrews, Angus P. II. Title.
QA402.3.G695 2008
629.8’312—dc22
200803733
Printed in the United States of America
10987654321
CONTENTS
Preface ix
Acknowledgments xiii
List of Abbreviations xv
1 General Information 1
1.1 On Kalman Filtering, 1
1.2 On Optimal Estimation Methods, 5
1.3 On the Notation Used In This Book, 23
1.4 Summary, 25
Problems, 26
2 Linear Dynamic Systems 31
2.1 Chapter Focus, 31
2.2 Dynamic System Models, 36
2.3 Continuous Linear Systems and Their Solutions, 40
2.4 Discrete Linear Systems and Their Solutions, 53
2.5 Observability of Linear Dynamic System Models, 55
2.6 Summary, 61
Problems, 64
3 Random Processes and Stochastic Systems 67
3.1 Chapter Focus, 67
3.2 Probability and Random Variables (RVs), 70
3.3 Statistical Properties of RVs, 78
v