Solve Maze :: Python By Fuse

Solve Maze

(Python 2.7.1)

จากบทความที่แล้วเรื่องการ Explore Maze เราจะได้ไฟล์ Text มาหนึ่งไฟล์ที่มีพิกัดของเส้นทางการเดินที่ไม่ใช่ทางตันไว้ จากนานเราจะใช้อีกโปรแกรมหนึ่งในการ Solve Maze เพื่อให้เมื่อนำหุ่นตัวใหม่ที่ไม่มีเซนเซอร์สามารถที่จะเดินออกจากเขาวงกตเองได้

ตัวอย่างไฟล์ Text โดยค่าแรก คือ แกน Y และค่าที่สอง คือ แกน X

14,8
13,8
13,9
13,10
12,10
12,11
11,11
10,11
10,10
9,10
8,10
7,10
7,11
7,12
7,13
6,13
5,13

ขั้นตอนการ Solve

1. เก็บค่าพิกัดเริ่มต้นของหุ่นยนต์ไว้
2. นำหุ่นไปวางที่ตำแหน่งนั้นโดยสังเกตจากแผนที่จำลองในบทความก่อนหน้านี้ โดยให้หุ่นหันหน้าไปทางทิศเหนือของแผนที่ ที่ได้จำลองมาเช่นเดียวกัน
3. จากนั้นจึงให้โปรแกรมอ่านพิกัดถัดไป
   
   • หากค่าแรกของค่าใหม่ลดลง หมายความว่าทิศที่จะเดินถัดไปจะอยู่ด้านหน้า โปรแกรมก็จะส่ง F สั่งให้หุ่น
   • หากค่าสองของค่าใหม่ลดลง หมายความว่าทิศที่จะเดินถัดไปจะอยู่ด้านซ้าย โปรแกรมก็จะส่ง L F สั่งให้หุ่นหันซ้าย และเดินหน้า
   • หากค่าสองของค่าใหม่เพิ่มขึ้น หมายความว่าทิศที่จะเดินถัดไปจะอยู่ด้านขวา โปรแกรมก็จะส่ง R F สั่งให้หุ่นหันซ้าย และเดินหน้า
4. เปลี่ยนทิศใหม่ไปตามที่หุ่นได้ทำการหมุ่นโดยเทียบจากทิศทางเดิม
 

By :: Terus Limsurut FRA14