Update on setpoint_attitude plugin

* changed Twist to TwistStamped
* added reverse_throttle option for throttle control
* use cmd_vel as the same topic to control linear a angular velocities (it's commonly used by controllers)
* added normalization filter to thrust