added sensor fusion and linear acceleration plotting
update code

Signed-off-by: ssepulveda <ssepulveda.sm@gmail.com>
fix typo
testing linear acceleration plotting, gravity and Angles