Changed RawPosition quadcopter id to uint32
Fixed adding every quadcopter twice on Init.

Added scripts to control module via ros.
Some quality assurance, some more debug output.