static inline void
add_sample(struct oprofile_cpu_buffer *cpu_buf,
unsigned long pc, unsigned long event)
{
struct op_sample *entry = &cpu_buf->buffer[cpu_buf->head_pos];
entry->eip = pc;
entry->event = event;
increment_head(cpu_buf);
}
void microdrive_restart() { // there's an access to a port. Reset counters and relocate the head
//printf("Inicializado\n");
while(((ordenador.mdr_tapehead%543)!=0)&&((ordenador.mdr_tapehead%543)!=15))
increment_head(); // put head in the start of a block
ordenador.mdr_bytes = 0; // reset current number of bytes written
if((ordenador.mdr_tapehead%543)==0)
ordenador.mdr_maxbytes = 15; // up to 15 bytes for header blocks
else
ordenador.mdr_maxbytes = 528; // up to 528 bytes for data blocks
}
byte microdrive_in(word Port) {
byte retorno;
/* allow access to the port only if motor 1 is ON and there's a file open */
if(((Port|0xFFE7)==0xFFE7)&&(ordenador.mdr_drive==0x01)&&(ordenador.mdr_current_mdr[0])) {
if(ordenador.mdr_bytes<ordenador.mdr_maxbytes) {
retorno=ordenador.mdr_cartridge[ordenador.mdr_tapehead];
basura=retorno;
increment_head();
} else {
retorno = basura;
}
ordenador.mdr_bytes++;
return (retorno);
}
if((Port|0xFFE7)==0xFFEF) {
if((ordenador.mdr_drive==0x01)&&(ordenador.mdr_current_mdr[0])) { // motor 1 ON and file selected
if(ordenador.mdr_gap) {
retorno=0xFE; // GAP and SYNC high
ordenador.mdr_gap--;
} else {
retorno=0xF8; // GAP and SYNC low
if(ordenador.mdr_nogap)
ordenador.mdr_nogap--;
else {
ordenador.mdr_gap=15;
ordenador.mdr_nogap=15;
}
}
if(!ordenador.mdr_cartridge[137922]) // if write protected
retorno|=0x01; // active bit
} else // motor 1 OFF
retorno=0xFF;
microdrive_restart();
return (retorno);
}
if ((Port|0xFFE7)==0xFFF7) {
microdrive_restart();
return (0xFF);
}
return(0xFF);
}
int16_t ring_put(buffer_data_t value, volatile buffer_data_t *buffer,
buffer_index_t buffer_size, volatile buffer_index_t *head,
volatile buffer_index_t *tail)
{
int8_t ret_val;
buffer_index_t temp_head = *head;
ret_val = increment_head((volatile buffer_index_t *) &temp_head, tail,
buffer_size);
if (ERR_NONE != ret_val)
return ret_val;
buffer[*head] = value;
*head = temp_head;
return ERR_NONE;
}
void microdrive_out(word Port,byte Value) {
int retval;
/* allow access to the port only if motor 1 is ON and there's a file open */
if(((Port|0xFFE7)==0xFFE7)&&(ordenador.mdr_drive==0x01)&&(ordenador.mdr_current_mdr[0])) {
if((ordenador.mdr_bytes>11)&&(ordenador.mdr_bytes<(ordenador.mdr_maxbytes+12))) {
ordenador.mdr_cartridge[ordenador.mdr_tapehead]=(unsigned int) Value;
increment_head();
ordenador.mdr_modified=1;
}
ordenador.mdr_bytes++;
return;
}
if((Port|0xFFE7)==0xFFEF) {
if(((Value&0x02)==0)&&((ordenador.mdr_old_STATUS&0x02)==2)) { // edge down-> new bit for motor ON
ordenador.mdr_drive=((ordenador.mdr_drive<<1)&0xFE); // rotate one drive
if(!(Value&0x01)) // if COM DATA is 0, we add a 1 bit to mdr_drive
ordenador.mdr_drive|=0x01;
if(ordenador.mdr_modified) { // if the cartridge has been modified, we store it in hard disk
ordenador.mdr_file=fopen(ordenador.mdr_current_mdr,"wb"); // create for write
if(ordenador.mdr_file==NULL) {
sprintf(ordenador.osd_text,"Can't store the cartridge");
ordenador.osd_time=150;
} else {
retval=fwrite(ordenador.mdr_cartridge,137923,1,ordenador.mdr_file); // save cartridge
fclose(ordenador.mdr_file);
ordenador.mdr_file=NULL;
ordenador.mdr_modified=0;
}
}
}
ordenador.mdr_old_STATUS=Value;
microdrive_restart();
return;
}
if ((Port|0xFFE7)==0xFFF7) {
microdrive_restart();
return;
}
}
void pop_front() {
assert(sz > 0);
increment_head();
--sz;
}
void circular_vector::stack(double value)
{
increment_head();
set(0,value);
}
