Behavioural templates improve robot motion planning with social force model in human environments.