/***************************************************************
*Copyright(c) 2020思特诺(Stduino)All right reserved.
*
*This library is open source and free for individual users. 
*
*For commercial use, please contact service001@stduino.com.
***************************************************************/

#include "StduinoPulse.h"

void analogWrite(uint8_t pin,uint16_t Value)
{
 *(uint32_t *)((uint32_t)_tim_grp(pin)+((_tim_prt(pin)-1)<<2)+0x34)=(Value);
 delayMicroseconds(1);
}

void tone(uint8_t pin,uint32_t hertz)
{
 uint32_t arr_add=2;
 uint32_t psc_add=1;
 uint32_t arr_data=0;
 uint32_t psc_data=0;
 uint16_t add_old=1000;
 uint16_t add_new=0;
 
 for(;arr_add<65536;arr_add+=2)
 {
 if(((72000000/(hertz*arr_add))<65536))
 {
 if((((72000000000/(hertz*arr_add))%1000))<10)
 {
 psc_add=(72000000/(hertz*arr_add));
 add_new=arr_add/psc_add+psc_add/arr_add;
 if(add_new<add_old||add_new<=200)
 {
 add_old=add_new;
 arr_data=arr_add;
 psc_data=psc_add;
 }
 }
 }
 }
 
 _tim_grp(pin)->ARR=arr_data-1;
 _tim_grp(pin)->PSC=psc_data-1;
 analogWrite(pin,(arr_data/2));
}

void noTone(uint8_t pin)
{
 settim(pin);
 analogWrite(pin,0);
}

uint32_t pulseIn(uint8_t pin,uint8_t state,uint32_t time)
{
 uint32_t time_start=micros();
START:
 if(digitalRead(pin)!=state)
 {
 while(1)
 {
 if(digitalRead(pin)==state)
 {
 uint32_t state_start=micros();

 while(1)
 {
 uint32_t time_now=micros()+1;
 if(digitalRead(pin)!=state)
 {
 return (time_now-state_start);
 }

 if((time_now-time_start)>=time)
 {
 return (time_now-state_start);
 }
 }
 }else
 {
 if((micros()-time_start)>=time)
 {
 return 0;
 }
 }
 }
 }
 else 
 {
 goto START;
 return 0;
 }
}

uint8_t shiftIn(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder)
{
 uint8_t value = 0;
 uint8_t i;
 
 for (i = 0; i < 8; ++i)
 {
 digitalWrite(clockPin, HIGH);
 
 if (bitOrder == 0)
 {
 value |= digitalRead(dataPin) << i;
 }else
 {
 value |= digitalRead(dataPin) << (7 - i);
 }
 digitalWrite(clockPin, LOW);
 }
 
 return value;
}

void shiftOut(uint8_t dataPin,uint8_t clockPin,uint8_t bitOrder,uint8_t val)
{
 uint8_t i;
 
 for (i = 0; i < 8; i++)
 {
 if (bitOrder == 0)
 {
 digitalWrite(dataPin, !!(val & (1 << i)));
 }else	
 {
 digitalWrite(dataPin, !!(val & (1 << (7 - i))));
 }

 digitalWrite(clockPin, HIGH);
 digitalWrite(clockPin, LOW);		
 }
}

/***************************************************************
*Copyright(c) 2020思特诺(Stduino)All right reserved.
*
*This library is open source and free for individual users. 
*
*For commercial use, please contact service001@stduino.com.
***************************************************************/