Navigating in rough terrain is a complex task that requires the robot to be considered as a holistic system. Algorithms, which don’t consider the physical dimensions and capabilities of the mobile robot lead to inefficient motion and suffer from a lack of robustness. A physical model of the robot is necessary for trajectory control. In this paper, quasi-static modeling of a six-wheeled robot with a passive suspension mechanism is presented together with a method for selecting the optimal torques considering the system constraints: maximal and minimal torques, positive normal forces. The aim of this method is to limit wheel slip and to improve climbing capabilities. The modeling and the optimization are applied to the Shrimp rover.