Rewrote PID implementation: removed bounds, added sampling time
Added initial quadcopter sketch