Added gates

Gate drawing, collision boundary finding is completed.
Next is to have collisions recognised.