defined conversion to std::vector<double>
added lastknownJointPos

changed autonomous so that WMRA moves immediately after the first waypoint calculation
lastKnownJoint position is updated everytime readPosall is called
UI improvements