From 9656a761ab38c8f2f96c345773dd0df93ca8db6d Mon Sep 17 00:00:00 2001
From: Paolo Paolucci <p.paolucci@tiscali.it>
Date: Wed, 23 Sep 2015 10:24:39 +0200
Subject: [PATCH] Add function setClock on Wire library

---
 libraries/Wire/Wire.cpp | 8 +++++---
 libraries/Wire/Wire.h   | 2 +-
 2 files changed, 6 insertions(+), 4 deletions(-)

diff --git a/libraries/Wire/Wire.cpp b/libraries/Wire/Wire.cpp
index 31e0a1d8a..c3cb62d21 100644
--- a/libraries/Wire/Wire.cpp
+++ b/libraries/Wire/Wire.cpp
@@ -49,12 +49,14 @@ void TwoWire::begin(uint8_t address) {
   sercom->enableWIRE();
 }
 
-void TwoWire::end() {
+void TwoWire::setClock(uint32_t baudrate) {
   sercom->disableWIRE();
+  sercom->initMasterWIRE(baudrate);
+  sercom->enableWIRE();
 }
 
-void TwoWire::setClock(uint32_t frequency) {
-	// dummy funtion
+void TwoWire::end() {
+  sercom->disableWIRE();
 }
 
 uint8_t TwoWire::requestFrom(uint8_t address, size_t quantity, bool stopBit)
diff --git a/libraries/Wire/Wire.h b/libraries/Wire/Wire.h
index 4b4ce1e44..ab7ccae60 100644
--- a/libraries/Wire/Wire.h
+++ b/libraries/Wire/Wire.h
@@ -38,7 +38,7 @@ class TwoWire : public Stream
     void begin();
     void begin(uint8_t);
     void end();
-    void setClock(uint32_t); // dummy function
+    void setClock(uint32_t);
 
     void beginTransmission(uint8_t);
     uint8_t endTransmission(bool stopBit);