[ardrone] Slow-Down Heading rate
[energy_ctrl] Energy loops not being called. Code commenting.