Added controller and kalman module