Update commands_logic.pde

Merging with current arducopter code...