Agility3 modelling and simulation

@agility3