config readback

tinygo-org · Sep 29, 2024 · 50ad4d4 · 50ad4d4
1 parent ac0194f
commit 50ad4d4
Show file tree

Hide file tree

Showing 2 changed files with 18 additions and 2 deletions.
diff --git a/ina219/errors.go b/ina219/errors.go
@@ -7,3 +7,7 @@ func (e ErrOverflow) Error() string { return "overflow" }
 type ErrNotReady struct{}
 
 func (e ErrNotReady) Error() string { return "not ready" }
+
+type ErrConfigMismatch struct{}
+
+func (e ErrConfigMismatch) Error() string { return "config mismatch" }
diff --git a/ina219/ina219.go b/ina219/ina219.go
@@ -45,10 +45,22 @@ func (d *Device) Configure() (err error) {
 		return
 	}
 
-	err = d.WriteRegister(
+	if err = d.WriteRegister(
 		RegCalibration,
 		d.config.Calibration.RegisterValue(),
-	)
+	); err != nil {
+		return
+	}
+
+	var readConfig Config
+	// make sure the configuration is read back correctly
+	if readConfig, err = d.ReadConfig(); err != nil {
+		return
+	} else if readConfig.RegisterValue() != d.config.RegisterValue() {
+		err = ErrConfigMismatch{}
+	} else if readConfig.Calibration.RegisterValue() != d.config.Calibration.RegisterValue() {
+		err = ErrConfigMismatch{}
+	}
 
 	return
 }