cvs.zerfleddert.de Git - rsbs2/blame_incremental

... / ...

Commit	Line	Data
	1	#include <avr/io.h>
	2	#include <avr/interrupt.h>
	3	#include <stdio.h>
	4
	5	#include "chassis.h"
	6
	7	#ifdef __AVR_ATmega16__
	8	#define CHASSISPORT B
	9	#define POWER_PIN 0
	10	#define RESET_PIN 1
	11	#define ACTIVE_LOW
	12	#else
	13	#error "Please add chassis power/reset-PIN information for this chip"
	14	#endif
	15
	16	#define __CPORT(port) PORT##port
	17	#define _CPORT(port) __CPORT(port)
	18	#define CPORT _CPORT(CHASSISPORT)
	19
	20	#define __CDDR(port) DDR##port
	21	#define _CDDR(port) __CDDR(port)
	22	#define CDDR _CDDR(CHASSISPORT)
	23
	24	static volatile int power_cnt = 0;
	25	static volatile int reset_cnt = 0;
	26
	27	static void chassis_set_pins(uint8_t pins, uint8_t state);
	28
	29	void chassis_init()
	30	{
	31	chassis_set_pins((1<<POWER_PIN) \| (1<<RESET_PIN), 0);
	32	CDDR \|= ((1<<POWER_PIN) \| (1<<RESET_PIN));
	33
	34	/* About 1ms */
	35	OCR0 = ((F_CPU/64)/1000) - 1;
	36
	37	TCCR0 = ((1<<WGM01) \| (1<<CS01) \| (1<<CS00)); /* CTC, Prescaler 64 */
	38	TIMSK \|= (1<<OCIE0);
	39
	40	}
	41
	42	static void chassis_set_pins(uint8_t pins, uint8_t state)
	43	{
	44	#ifdef ACTIVE_LOW
	45	state = !state;
	46	#endif
	47
	48	if(state) {
	49	CPORT \|= pins;
	50	} else {
	51	CPORT &= ~pins;
	52	}
	53	}
	54
	55	static void chassis_power(int msec)
	56	{
	57	uint8_t old_SREG = SREG;
	58
	59	chassis_set_pins((1<<POWER_PIN), 1);
	60
	61	cli();
	62	if (!power_cnt)
	63	power_cnt = msec;
	64	SREG = old_SREG;
	65	}
	66
	67	static void chassis_reset(int msec)
	68	{
	69	uint8_t old_SREG = SREG;
	70
	71	chassis_set_pins((1<<RESET_PIN), 1);
	72
	73	cli();
	74	if (!reset_cnt)
	75	reset_cnt = msec;
	76	SREG = old_SREG;
	77	}
	78
	79	void chassis_control(unsigned char action)
	80	{
	81	#ifdef DEBUG
	82	printf("Chassis control 0x%02x\n", action);
	83	#endif
	84
	85	switch(action) {
	86	case CHASSIS_ACTION_POWER_DOWN:
	87	chassis_power(5000);
	88	break;
	89
	90	case CHASSIS_ACTION_POWER_UP:
	91	chassis_power(200);
	92	break;
	93
	94	case CHASSIS_ACTION_HARD_RESET:
	95	chassis_reset(200);
	96	break;
	97
	98	default:
	99	#ifdef DEBUG
	100	printf("Unimplemented chassis action 0x%02x\n", action);
	101	#endif
	102	break;
	103	}
	104	}
	105
	106	ISR(TIMER0_COMP_vect)
	107	{
	108	if (power_cnt) {
	109	power_cnt--;
	110
	111	if (!power_cnt)
	112	chassis_set_pins((1<<POWER_PIN), 0);
	113	}
	114	if (reset_cnt) {
	115	reset_cnt--;
	116
	117	if (!reset_cnt)
	118	chassis_set_pins((1<<RESET_PIN), 0);
	119	}
	120	}