                 if mutablePath.count() > 0 {
                     routePath.path = mutablePath
                     routePath.mutablePath?.removeCoordinate(at: 0)
+                    
+                    let coord = mutablePath.coordinate(at: 0)
+                    currMarker.position = coord
                     break
                 }
             }

        route = [routePathA, routePathB]
        
        drawMapRoute()
        testDrawing()
    }
    
    // MARK: Map and Route Methods
    
    // Call this function to simulate travelling on route
    func testDrawing() {

import GoogleMaps

class MapViewController: UIViewController, GMSMapViewDelegate {
    
    // Constants
    let markerRadius: CGFloat = 10

    // Variables
    var mapView: GMSMapView!
    var route: [Path] = []
    var waypointsA: [Waypoint] = []
    var waypointsB: [Waypoint] = []
    var currMarker: GMSMarker!

    override func viewDidLoad() {
        super.viewDidLoad()
