Object-oriented modeling of industrial manipulators with application to energy optimal trajectory scaling