Made changes so that SerialCommandManager and NavManager use different ports when initialised, avoiding PortAlreadyInUse exception.
Further changes need to be done to make both managers use the same port.
Code for sending takeOff command is almost concluded, but still need to solve a problem with the writers and test it, which will probably require some changes.