Added Side vector and Perp Function Don't know if Perp function is correct found it on internet!