Control function for hip motors