Fixed something in documentation after meeting
Algorithm for linearization done. Start final tested.