This paper introduces a trajectory planning algorithm for long-term Freeway driving for autonomous vehicles including different modes of motion. In the autonomous driving in a Freeway, different maneuvers are needed, including free flow, distance adaption, speed adaption, lane change and overtaking. This paper introduces an algorithm that provides all of these driving scenarios in the trajectory planning for an autonomous vehicle. All maneuvers are classified and proper formulation for each driving mode formulated. Then, an algorithm is introduced to show the procedure of decision making and switching between all driving modes. The relative distances and velocities of the other peripheral and front vehicle from autonomous vehicle are considered as the main factors for decision making during the travelling in the Freeway. By the developed simulation programming, validity and effectiveness of the algorithm are verified, and pseudo code and flowchart for the simulation programming are introduced. Later in two simulation studies, different driving conditions are generated and results have been discussed and analyzed by detail.