There has been an increase of attention given on autonomous technology from major players in the autonomous industry lately, due to the fact that this technology can be implemented in both civilian and military applications. The primary goal of an autonomous control development is to make the vehicle easily controllable by an inexperienced user, even in situations where the vehicle is being obstructed. Designing such system requires an effective program that can take real-time inputs from the environment and use them to determine the correct steering angle and speed in order for the vehicle to navigate through its waypoints efficiently. A control system for lateral and longitudinal attitude is configured using ArduPilot Mega micro controller and Mission Planner software, where a test area was used to verify the effectiveness of the developed autonomous control system by testing various firmwares with different parameter values. Then, three cases with different parameter inputs will be tested in the aforementioned test area to collect the essential data to be analysed. The developed AGV managed to collect various data such as yaw motion and floating distance from intended waypoints which can be further analysed by other parties that are interested in this area of study.