ใครมีโค้ดวัดระดับน้ำในถังบ้าง??

M=1;   // กำหนดให้เติมน้ำก่อนจนเต็ม  สมมุติว่าถังมันว่างตอนเริ่มต้น


/// (วนลูบการทำงาน )
MAX = readSwitchMax();  //อ่านค่าสถานะสวิทช์หรือเซ็นเซอร์ด้านบน
MIN = readSwitchMin();  //อ่านค่าสถานะสวิทช์หรือเซ็นเซอร์ด้านล่าง

/// เหตุการแรก เติมน้ำและน้ำเต็ม
if ( M==1;  && MAX ==1  && MIN ==1 )   /// มีการสั่งให้ปั๋มทำงาน และน้ำเต็ม
  {
   M=0;  /// สั้งหยุดปั์ม
  }

//// เหตุการที่สอง น้ำกำลังลด  ก็ให้ลดต่อไปจนกว่าจะต่ำสุดๆ
if ( M==0 &&  MAX ==0  && MIN == 1)  ///  MIN ยังจับได้ว่ามีน้ำเกินกว่าระดับล่างสุด
{
M=0;  /// สั้งหยุดปั์ม
}

//// เหตุการที่สาม น้ำลดจนต่ำ  
if ( MAX ==0  && MIN == 0)   /// ต่ำกว่าระดับล่างสุด
{
M=1;  /// สั้งปั์มทำงาน
}

//// เหตุการที่สี่  น้ำสูงกว่าระดับล่างสุด แต่ยังไม่ถึงระดับสูงสุด ก็ให้เติมต่อไป  
if ( M==1  &&  MAX ==0  && MIN == 1)   /// สูงกว่าระดับล่างสุด
{
M=1;  /// สั้งปั์มทำงาน ต่อ
}