Fixed header path
Added framework, manual joint controls
Added servo control