Sensor Fusion Autonomous Driving Algorithms For Rubiksolve