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