multiwii cleanup part I.