Added positive and negative windup directions to avoid lock-ups.
Merge branch 'ldtravocean_branch_v2' of http://github.com/labust/labust-ros-pkg into ldtravocean_branch_v2