added solver methods (need testing), added util for solving diag+lowrank
added optimized RTS smoother, better test
improvements to test and organization
improved comments
improved comments
cleaned up test