Intelligent Mobility System with Integrated Motion Planning and Control Utilizing Infrastructure Sensor Nodes