added smoothstep function. trying to debig timeing issues
servo folowing set sequences with vairable time delays for each move, compile errors fixed : printf messes with timeing, only use for testing
housekeeping: standardised function names to use camel case, updated function headers and removed old un-used code.
Merge branch 'master' into Queron