Adding more commands

Tested Rudder control and hold station and they work correctly. Read and
write waypoint have not been confirmed to work yet.