add shiftIn and shiftOut

Author: oclyke

core-extend/Common.h

@@ -44,6 +44,12 @@ void            analogWriteDAC(pin_size_t pinNumber, int val);
 void            indexAnalogWrite(pin_size_t index, int val);
 void            analogWrite(PinName pinName, int val);
 
+void indexShiftOut(pin_size_t data_index, pin_size_t clock_index, BitOrder bitOrder, uint8_t val);
+void shiftOut(PinName dataPinName, PinName clockPinName, BitOrder bitOrder, uint8_t val);
+
+pin_size_t indexShiftIn(pin_size_t data_index, pin_size_t clock_index, BitOrder bitOrder);
+pin_size_t shiftIn(PinName dataPinName, PinName clockPinName, BitOrder bitOrder);
+
 #ifdef __cplusplus
 
 void            indexTone(pin_size_t index, unsigned int frequency, unsigned long duration = 0);

core-implement/CommonDigital.cpp

@@ -109,3 +109,61 @@ PinStatus digitalRead(PinName pinName){
     if( index == variantPinCount ){ return LOW; }
     return indexDigitalRead(index);
 }
+
+void indexShiftOut(pin_size_t data_index, pin_size_t clock_index, BitOrder bitOrder, uint8_t val){
+	for (uint8_t idx = 0; idx < 8; idx++)  {
+		if (bitOrder == LSBFIRST) {
+			indexDigitalWrite(data_index, !!(val & (1 << idx)) ? HIGH : LOW);
+        }else{
+            indexDigitalWrite(data_index, !!(val & (1 << (7 - idx))) ? HIGH : LOW);
+        }	
+		indexDigitalWrite(clock_index, HIGH);
+		indexDigitalWrite(clock_index, LOW);		
+	}
+}
+
+void shiftOut(pin_size_t dataPinNumber, pin_size_t clockPinNumber, BitOrder bitOrder, uint8_t val){
+    pin_size_t data_index = pinIndexByNumber(dataPinNumber);
+    pin_size_t clock_index = pinIndexByNumber(dataPinNumber);
+    if( data_index == variantPinCount ){ return; }
+    if( clock_index == variantPinCount ){ return; }
+    indexShiftOut(data_index, clock_index, bitOrder, val);
+}
+
+void shiftOut(PinName dataPinName, PinName clockPinName, BitOrder bitOrder, uint8_t val){
+    pin_size_t data_index = pinIndexByName(dataPinName);
+    pin_size_t clock_index = pinIndexByName(clockPinName);
+    if( data_index == variantPinCount ){ return; }
+    if( clock_index == variantPinCount ){ return; }
+    indexShiftOut(data_index, clock_index, bitOrder, val);
+}
+
+pin_size_t indexShiftIn(pin_size_t data_index, pin_size_t clock_index, BitOrder bitOrder){
+	uint8_t value = 0;
+	for (uint8_t idx = 0; idx < 8; ++idx) {
+		indexDigitalWrite(clock_index, HIGH);
+		if (bitOrder == LSBFIRST){
+			value |= indexDigitalRead(data_index) << idx;
+        }else{
+			value |= indexDigitalRead(data_index) << (7 - idx);
+        }
+		indexDigitalWrite(clock_index, LOW);
+	}
+	return value;
+}
+
+pin_size_t shiftIn(pin_size_t dataPinNumber, pin_size_t clockPinNumber, BitOrder bitOrder){
+    pin_size_t data_index = pinIndexByNumber(dataPinNumber);
+    pin_size_t clock_index = pinIndexByNumber(clockPinNumber);
+    if( data_index == variantPinCount ){ return 0x00; }
+    if( clock_index == variantPinCount ){ return 0x00; }
+    return indexShiftIn(data_index, clock_index, bitOrder);
+}
+
+pin_size_t shiftIn(PinName dataPinName, PinName clockPinName, BitOrder bitOrder){
+    pin_size_t data_index = pinIndexByName(dataPinName);
+    pin_size_t clock_index = pinIndexByName(clockPinName);
+    if( data_index == variantPinCount ){ return 0x00; }
+    if( clock_index == variantPinCount ){ return 0x00; }
+    return indexShiftIn(data_index, clock_index, bitOrder);
+}