Add doxygen comments to motorcontrol class
Added doxygen comments to KalmanFilter class