Updated GSM functionalities to match firmware design. GPS update.

More functionalities and more progress into our final design. Integration can begin. :)