Scheduling and priority added. Stuck at trying to get the package to
work with ros.