Initial commit of stock Multiwii 2.2