Refactored the control_system and the simulator stack

All the modules inside these two stacks have been refactored.
@icyflame  there is a problem here there are two topics /kraken/forceData6Thruster this is force data for a 6 thruster model and /kraken/forceData4Thruster this is forcedata for a 4 thruster model