using functions for SHITL
added SHITL block.
remved c99 'for 'error.
added chavailable function
function removed
increased buffer size.
paparazzi added